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ABSTRACT 


Planning efficient long-range movement is a fundamental requirement of most military operations. 
Intelligent mobile autonomous vehicles designed for battlefield support missions must have this capability. 
We propose an efficient heuristic algorithm for planning near-optimal high-level routes through complex 
terrain maps, modeled by the Weighted-Region Problem (WRP). The algorithm is driven by our adaptation 
of the combinatorial optimization technique called simulated annealing. The WRP provides a 
cartographically powerful representation for planar maps. Terrain features are modeled by polygonal 
homogeneous-cost regions. A cost coefficient assigned to each region indicates the relative cost per unit 
distance for movement in that region by a point agent on the ground. Region cost coefficients are assumed to 
be invariant with direction of movement. Given a start and a goal point, a solution (not necessarily optimal) 
is a set of piecewise-linear connected segments, spanning from start to goal. The cost of a solution path is the 
sum of the weighted lengths of all segments in the path, where the weighted length of each segment is the 
product of its Euclidean length and the cost coefficient of the region it crosses. Ideally, we seek the least cost 
path. However, as problem instances approach the actual complexity of the battlefield, faster solutions 
become more desirable than absolute optimality. We introduce heuristics designed to reduce the search space 
independently of start and goal location, thus, allowing map preprocessing. We use other heuristics to 


improve the efficiency of local cost function optimization as well as the anncaling process itself. 
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I. INFRODUCTION 


A. OVERVIEW 


Planning efficient long-range movement using map data is fundamental to most military operauions. 
Intelligent mobile autonomous vehicles designed for battlefield support missions must also do this. Within 
the last decade, successes in the development and practical use of robotic and automation equipment have 
created a demand for more efficiency and capability in autonomous machines [Iyen89]. Furthermore, U.S. 
Department of Defense interest in autonomous land vehicles [Keir88, Keir84], automated battle management 
systems [Wilb89], and digital terrain analysis [Digi88, Clev84], has significantly augmented this demand. 
Inspired by these requirements, this dissertation presents our design and implementation of an efficient 
algorithm for high-level route planning through complex terrain. Our algorithm, which we refer to as path 
annealing, finds solutions to what has been called the weighted-region problem [Mitc90]. 

Most previous approaches to the weighted region problem have used systematic search methods. Such 
techniques may extract huge overheads for agenda maintenance. When problem instances become large and 
complex, even heuristics can be ineffective in reducing the combinatorics. In contrast, path annealing 
employs a form of adaptive local search, which samples the solution space and eliminates the need to maintain 
expensive agendas. As the name suggests, path annealing is based on the probabilistic search technique 
known as simulated annealing, which was first explored independently by [Kirk83] and [Cern85). In adapting 
this technique to solve the weighted region problem, we have also designed many heuristics based on 
annealing, spatial reasoning, and geometry. These enhance performance and also tend to compensate for the 
weaknesses inherent in local search. Empirical studies indicate that compared to A* search on relatively large 
problem instances, path annealing has significantly lower execution umes, while sacrificing very little 
solution accuracy. Although, our algorithm cannot guarantee a globally shortest path, our empirical study 


indicates that it will find it quite often. 


B. DEFINITION OF THE WEIGHTED-REGION PROBLEM (WRP) 
The weighted region problem (WRP) uses a mathematically simple, yet cartographically powerful 
problem representation. Input to the WRP is a two-dimensional planar map, which models terrain features as 


convex polygonal homogeneous-cost regions. We say that a WRP map is a connected planar straight-line 


graph which partitions two-dimensional space into cost regions. Each cost region is assigned a cost 
coefficient, which is a weighting value indicating the relative cost per unit distance for movement through 
that region by a point agent. Cost regions are assumed to be isotropic, so that their respective cost coefficients 
are invariant with respect to direction of movement. Without loss of generality, cost coefficients are integers 
taken from the set {w, w+], w+2, ..., W,t00}, where w and W are the minimum and maximum weights 
respectively. If necessary, rational number coefficients can always be handled by rescaling [Mitc90]. A 
weighted-region problem instance 1s a WRP map specified in terms of boundary edges and cost coefficients, 
and designated start and goal points corresponding to the current location and projected destination of the 
agent. 

A solution (not necessarily optimal) is a set of piecewise linear connected line segments, which spans 
from start point S to goal point G (see Figure 1.1). Denote this path as Poo The interior points of each segment 
of P we lie either entirely within a single cost region, or entirely on a single cost region boundary. Segment 
end points lie on region boundary edges or vertices. The total cost of P ee is the sum of the weighted lengths 
of all segments of the path, where the weighted length of segment / is the product of its Euclidean length, d., 


and the cost coefficient, L., of the region through which it passes: 
IP" soll = D4) (Eq 1.1) 
i 


A path segment which coincides with all or part of a boundary edge incurs the lesser cost of the two regions 


SG ’ 
Measured in time units, it represents the fastest route from start to goal. 


separated. An optimal solution, P is the minimization of Eq 1.1, a globally least cost path from S to G. 

We make several additional assumptions regarding the input map. We assume that all weighted regions 
are convex. Even if this is not the case, it is always possible to insert additional boundary edges between 
existing vertices to make all regions convex. Such edges will become boundanes between regions of equal 
cost. We will refer to these as phantom edges because their sole purpose is to ensure convexity. Border edges 
and border vertices define the outer limits of the map, and bound the only non-convex region. The current 
implementation of path annealing requires that linear regions (as used in [Rowe90a] and [Mitc90]) must be 
modeled by regions of positive (non-zero) area. However, this restriction is not essential to the algorithm 


itself, and can be removed by a few data structure modifications. 





Figure1.1 Weighted-Region Problem Instance and One Possible Solution 
(not necessarily optimal) 


C. WHY A STOCHASTIC APPROACH? 

Algorithms based on systematic search methods apply some deterministic ordering to nodes in a state 
space search. The usual reason for this is to guarantee search completeness, which may be the only known 
way to guarantee the optimality of a solution. Such algorithms must track a large number of partial solutions 
using an agenda. However, this does not imply that ordered search is necessarily exhaustive. Heuristics and 
bounds may provide sufficient cause to prune partial solutions from further consideration. Nevertheless, such 
search organization sometimes carries a hefty price in the form of agenda maintenance. Larger, more 
complicated problem instances will generally require more effort of these deterministic algorithms, likely 


forcing unacceptably worst case performance. 


Rather than incur the overhead for organized search, we propose to reduce the effort by using stochastic 
search. Path annealing is our customization of simulated annealing [Kirk83], a probabilistic combinatorial 
optumization technique which finds near-optimal solutions to problems having very large and complex search 
spaces. The annealing approach to the WRP may seem strange for several reasons. First, the WRP is 
polynomially solvable [Mitc90], yet, annealing’s primary domain of application is generally considered to be 
the class of NP-Hard problems. Second, simulated annealing has often been criticized for its large running 
times which are sometimes necessary to ensure good solutions. Finally, for some problems, annealing has 
made a relatively poor showing against good problem-specific heuristics [Naha85]. Although annealing may 
not appear to be the correct tool for the WRP, our empirical studies tend to indicate otherwise. 

Annealing experiments with the Traveling Salesman Problem exhibit a property which is similar to a 
human approach to route planning. Consider planning a long-range automobile trip using a road atlas. Most 
people form a solution hierarchically, descending top-down through levels of abstraction from interstate 
expressways to state highways to local roads. Two basic forms of knowledge contribute to this natural 
tendency. The first is general knowledge of speeds and traffic patterns associated with the major classes of 
roads. The second is specific experience-based and analogical knowledge about road quality and traffic 
patterns in local areas of the map. To solve the Traveling Salesman Problem, simulated annealing forms a 
solution in this same top-down progression [Kirk83]. Starting with an initial feasible solution, the algorithm 
samples the search space by rapidly generating and testing random solutions. In the beginning the process 
finds many of the best gross high-level solutions. The effects of random samples are gradually constrained so 
that these gross high-level solutions tend to freeze into the evolving detailed solution. Later stages of the 
process generate and test smaller local changes, gradually refining the lower-level details of a final near- 
optimal solution. 

Hard optimization problems with complex solution spaces usually have a large number of local minima 
with costs very near to that of the optimal solution(s) [Kirk83]. The WRP solution space, characterized by 
multiple local minima, appears to be well-suited for a stochastic approach, especially in larger problem 
instances. A high resolution requirement for terrain modeling could easily produce a problem instance which 
would be arbitrarily complex in terms of vertices, boundary edges, regions, and their shapes and orientations. 
Consider the case of an input map which is an approximate model of the real world. The sensitivity of true 
optumal paths to very small changes in geometry and cost coefficient magnitude suggests that the effort 
associated with finding a true optimal path is rarely worth the result. Simulated annealing proceeds under this 


assumption, and finds a near-best solution without the expense of systematically proving its worth. 


New approaches to problems often suggest additional constraints, heuristics, or bounds which might not 
have been possible with earlier methods. Experience with annealing indicates that tailored heuristics can 
increase its efficiency [Rome84b, Whit84, Gree84, Naha85, Adam85]. We have borrowed several methods 
of improvement from previous work. In addition, we have developed several of our own heuristics and 
constraint mechanisms which are specific to the WRP and path annealing. Some of our heuristics can also 
Support other path planning algorithms. Our stochastic approach to the WRP attempts to merge simple 


intelligence with practical engineering by coupling simple heuristics to non-exhaustive, controlled sampling. 


D. APPLICATIONS 


If we consider the WRP ina military planning context, then its significance to automated route planning 
becomes more apparent. The problem ts generic enough to model a variety of spatially onented applications. 
For a given map, regions and associated cost coefficients can represent any unit of measure provided that 
within each region, cost remains isotropic, homogeneous, and varies linearly with planar distance. Examples 
of cost measure include ease of movement through terrain, cover and concealment, exposure to enemy 
positions, fuel or energy consumputon, lethality of enemy weapons, or areas of contamination [Wilb89, 
Rowe90d]. Multiple weighted-region maps could be merged by overlaying one atop another and performing 
a combining operation on the cost coefficients of intersecting areas. The composite map would have 
additional new vertices and regions with revised boundary edges resulting from boundary-edge intersections 
and region overlaps. A route planning algorithm operating on such a map would simultaneously optimize 
Over several mission-critical parameters. For example, by using cost coefficients obtained from weighting the 
the relative importance of each cost parameter, an optimal solution on such a composite map might represent 
the path of combined minimum travel time, least exposure to the enemy, and maximum survivability 
[Dent84]. In general, the complexity of route-planning on merged maps grows with the number of boundary 
edge intersections and cost region overlaps. The need for fast solutions assumes increasing importance as the 
scope of a problem instance approaches the reality and complexity of battlefield mission planning. 

For a given problem instance, each execution of a stochastic algorithm can result in a different solution. 
Whether executed in a parallel processing environment or given ample ume to conduct multiple executions 
serially, the best outcomes can be selected. A collection of different solutions from several processors can 
provide insights into terrain overlays that might otherwise go unnoticed. For example, high-speed avenues of 
approach, key choke points, and major by passing routes become more apparent as the military planner 


correlates multiple solutions. 


Solutions generated by a nondeterministic approach such as path annealing are appealing from the 
military commander’s perspective for several reasons. A globally optimal path retuned by a deterministic 
algorithm is predictable and may be very undesirable in an offensive tactical plan. An algorithm which only 
finds a globally optimal path for a given problem instance will convey little surprise to an enemy, since he 
can do likewise with a deterministic algorithm! On the other hand, a stochastic algorithm has a reasonably 
good probability of discovering an optimal solution, but one of many near-optimal paths may be more likely. 
Since such paths are not always spatially close to the optmal, routes found by the stochastic algorithm are 
not always predictable. 

If route planning must be conducted under time-vanable constraints, then nondeterministic path 
annealing has a definite advantage over the systematic approaches. Systematic search usually must run to 
completion or near-completion in order to obtain a complete solution. In contrast, an annealing algorithm 
approaches the optimal solution, i.e. its theoretical asymptotic limit, as ime of execution approaches infinity 
{Rome84a]. This means that the quality of a solution can improve with time. The starting point of annealing 
is a feasible solution. Therefore, even when time constraints are uncertain, it would be possible to abort path 
annealing prematurely to return the best solution currently known. The more ume allotted to the algorithm, 
the more opportunities exist for solution improvement. 

As we have said, an important advantage provided by path annealing is its ability to achieve dramatic 
reductions in average computation ume necessary to find good solutions, particularly as problem instances 
become larger and more complex. This is because the annealing algorithm only samples the solution space, 
and is guided probabilistically by the sampling results. The random nature of the sampling process means that 
overhead for maintenance of partial solutions in an ordered agenda is unnecessary. In general, a predefined 
set of parameters constituting an annealing schedule determines the expected running time of an annealing 
algorithm. Figures 5.33 and 5.34 in Chapter V (page 125) show time of exccution as a function of problem 
size for 66 different weighted-region problem instances for A* search and path annealing respectively. This 
figure illustrates our claim that path annealing can require significantly less average running ume than a 
typical systematic search algorithm. In a majority of these 66 cases the total weighted path cost of the path 


annealing solution is the same (or nearly the same) as the systematic search solution cost. 


E. ORGANIZATION OF CHAPTERS 


We begin in Chapter II by discussing basic concepts and terms relevant to this and previous research. 


The chapter summarizes past approaches to solving the WRP and closcly related problems, emphasizing 


strengths and weaknesses. We also discuss simulated annealing and some examples of its uses. In Chapter III 
we present the development of path annealing. This chapter is organized around the components of a basic 
annealing algorithm. While only a few enhancements are discussed in Chapter III, Chapter IV emphasizes 
performance improvements to path annealing that are achieved through heuristics and bounds. Some of these 
are applicable to other approaches to the problem as well. In order to test and evaluate path annealing, we 
must have a valid means of comparison and control. Chapter V begins with a discussion of the wavefront 
propagation algorithm. We then describe another simple control algorithm which is uniquely different from 
previous algorithms for the WRP. We refer to it as uniform-discrete-point global A* (UDPGA*) search. We 
compare the performance of UDPGA* to wavefront propagation and show that UDPGA*%* Is a faster, more 
accurate systematic search algorithm. We then directly compare path annealing with UDPGA* for a variety 
of maps. The remainder of Chapter V is a summary of these test results and analysis. Chapter VI summarizes 


our conclusions and suggests extensions to this research. 


Ii. RELEVANT CONCEPTS AND PREVIOUS RESEARCH 


A. FUNDAMENTAL CONCEPTS 
1. Problem Representation 


a. High-Level vs. Low-Level Path Planning 


The work reported in this dissertation addresses only high-level aspects of path planning. In 
high-level route planning we assume that the moving agent is a point which has no physical dimension. Thus, 
there is no consideration of restrictions to movement due to the agent’s width or height. This is a reasonable 
assumption when the map scale is of relatively low resolution as compared to the size of a human or a small 
vehicle. We have tested our algorithms on a 1000 meter grid square extracted from a standard 1:50000 scale 
military map {[Defe74]. One unit of distance in our test maps is equivalent to approximately 10 meters distance 
on the ground. For a small vehicular agent, this is probably close to the maximum resolution before height 
and width constraints become active. 

A high-level solution provides a general route for cross-country movement. The agent may 
sull require a low-level path planning system to navigate the path. The low-level planner accumulates local 
sensory input and applies spatial reasoning to refine and safely follow the route as necessary for actual 
movement. Our work does not concem planning at this level. 

The goodness of a high-level solution depends to a large degree on how well the map 
represents the realitics of the terrain. The fact that WRP maps approximate curved features with straight lines 
is One source of representation error. Another source can result from cost coefficient assignment which 1s 
inconsistent with the actual cost per unit distance for movement on the ground. The mechanical aspects of our 
algorithm design assume that input maps are perfect representations of the terrain. However, of necessity, the 
representation of curves by straight lines normally approaches some finite precision (though possibly very 
small). Therefore, maps will usually differ from reality to some degree. Our design takes a pragmatic 
approach to optimization. There is little reason to expend large amounts of time searching exhaustively for a 
solution whose optimality may be questionable. In larger, more complex problem instances, there may be 


many near-optimal routes from which to select. 


b. Graph Search vs. Spatial Reasoning Approaches 

There are two general approaches to route finding: graph search and spatial reasoning. The 
graph-search approach represents the search space as a network of nodes and arcs through which a route must 
be found. The major advantage here is the ability to apply graph theory to obtain solutions. The very nature 
of many well-defined search problems dictates this discrete approach. Path constraints are the usual reason. 
For example, in city route planning for an automobile, clearly, there is no reason to consider off-road 
movement. In contrast, a spatial-reasoning approach considers the significance of shape, size, and orientation 
of features of the environment. The geometry of space and its effect on the cost of movement becomes more 
important. 

It appears that a graph-search approach alone cannot sufficiently capture the spatial 
relationships inherent in a weighted-region problem (WRP) instance. Most of the previous work in the WRP 
makes heavy use of spatial reasoning to develop constraints and bounds on the locations and costs of optimal 
solution paths. Searching outward systematically from the start point, these constraints are continually 
tightened until only a few routes remain that can satisfy conditions for global optimality. Then, either a graph 
search or cost comparison selects the optimum. 

Path annealing combines graph search and spatial reasoning in a more balanced mix. 
Whereas most of the previous algorithms focused on spatial reasoning to build a global solution, path 
annealing uses a fast, low-resolution graph search to get an initial solution. From this solution the algonthm 
probabilisucally explores local spatial relauonships among neighboring paths. Local graph search and the 
application of spatial constraints determine local optimal path-costs necessary to develop these relationships. 


The cumulative effect of all of this localized activity gradually determines a refined global solution. 


c. Discrete vs. Continuous Representation 
Optimization problems may be classified into two general categories — continuous and 
discrete [Papa82]. The discrete problems are also called combinatorial optimization problems. The solution 
techniques for each category are usually quite different and depend upon the form of the input. For example, 
calculus and binary search are two typical methods of continuous-variable optimization. Which to apply 
depends upon whether a continuous function is input as an equation or as raw data. On the other hand, 
standard graph theory provides discrete optimization techniques for finding shortest paths in networks of 


weighted arcs. 


The WRP has both discrete and continuous characterisucs. Two-dimensional Euclidean 
space imposes an uncountably infinite set of feasible paths between any pair of points, implying that 
continuous optimization might be applicable. However, the need to manage combinatorial complexity 
encourages a discrete flavor in problem representation. A finite set of boundary edges and vertices partitions 
the continuous space of weighted region maps. The geometric simplicity of the resulting polygons provides 
a natural way to manage the complexity and continuity of the WRP. We can divide a problem instance into a 
finite set of continuous path subspaces whose boundaries are defined by the discrete edges and vertices. 
Figure 2.1 depicts one such path subspace as defined by [Rich87]. 

The convexity theorem of [Rowe90b, Mitc90] lends further support for such a discrete 
representation. Simply stated, it concludes that for any path subspace with common start point and which 
crosses the same ordered sequence of boundary edges, weighted cost is a convex function of the parameters 
necessary to specify a path. The path subspace in Figure 2.1 satisfies the conditions of this theorem. The 
parameters necessary to specify each path are the coordinates of the start point and the boundary crossings. 
The theorem implies that there must exist within this subspace a unique path with minimum weighted cost. 


A continuous-function optimization technique (e.g. binary search) can determine this minimum cost path. 





Figure 2.1 Well-Behaved Path Subspace (also called a wedge) 
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We can take advantage of the convexity theorem by allowing boundary edges and vertices to 
define a discrete set of path-subspaces between start and goal. Each subspace contains a continuous family of 
paths. By the convexity theorem we can obtain the locally shortest path within each subspace. However, there 
are other advantages. Discrete data structures are easy to implement and can efficiently support both graph 
search and spatial reasoning. Another advantage is that imposing a discrete structure on continuous space 
results in a combinatorial optimization problem. While the search space may be very large, it is nevertheless 


finite. 
2. Sources of Error 


a. Terrain Representation 


Recall that in Section A.1.a of this chapter we briefly addressed terrain representation error. 
The solution accuracy for all current WRP solution techniques is dependent upon the accuracy with which 
straight lines approximate curves. This may have a direct influence on the size of a problem instance. The 
more straight lines necessary to maintain terrain representation accuracy requirements, the larger will be the 
number of vertices and edges in the map. The other source of representation error results from the use of 
homogeneous-cost regions. Of necessity, these regions are bounded areas. Their cost coefficient values are 
subjective averages, assigned because they best approximate cost per unit movement within that area from a 
high-level perspective. While errors will always exist, we assume that they will tend to cancel one another or 
average out over an entire high-level solution path. 

We can quantify the effect of cost coefficient assignment error as follows. Let H represent 
the maximum difference between assigned and true cost coefficient values over all regions of the map. If Max 
represents the maximum cost coefficient, then for a path of unweighted length L, HLy is the absolute 
maximum error in total path-cost induced by cost coefficient errors. This result assumes that the solution path 
uses regions of weight eee exclusively. But, the problem objective is to locate the least-cost path. So, the 
occurrence of the maximum error is very unlikely, because good solutions will use Hoax 2S infrequently as 
possible. For this reason, average error will be much lower. Also, consider that // may be a positive or 
negative deviation. Unless cost coefficient assignments are biased high or low, errors will tend to cancel over 
an entire solution path. The effect on total path-cost may then be minimal. 

From a mathematical perspective our algorithm design assumes that input maps are accurate 
representations of the terrain. However, a probabilistic approach assumes a more practical perspective. Why 


conduct an extensive, time-consuming systematic search for an optimal solution whose accuracy depends on 
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the accuracy of the map? A stochastic algorithm which performs controlled sampling can be faster, 
particularly for larger problem instances. Furthermore, we can design such an algorithm to be less sensitive 
to the accuracy of an input map. A search guided by cost function gradients in the space of complete solutions, 
can make extensive use of rapid approximations. It can choose to compute more carefully and accurately only 
when sampled costs indicate such a computation might be fruitful. A systematic search can also be guided by 
cost gradients. However, most of its time is spent examining partial solutions. Cost gradients of complete 


solutions contain more knowledge than those of partial solutions. 


b. Total Path Cost 

A computed solution path cost may not always be precise. Local optimality conditions are 
complex enough to admit irrational number solutions. As a result, many computed path costs are necessarily 
approximations. Furthermore, geometric problems like the WRP usually require many line intersections and 
point location procedures. This increases the likelihood round-off errors due to subtractions between near 
equal values as happens in computing the intersection of two near-parallel lines. Since solution paths are 
piecewise linear between such intersection points, then such round-off errors can accumulate, widening the 
gap between true and computed total path cost. It is often possible to identify and replace such calculations 
with more rational logic. For example, we can identify a parallel condition to a predetermined precision (s1x 
decimal digits for Quintus Prolog Version 2.0 [Quin90}), then explicitly select the point of intersection rather 


than compute it. 


c. Path Location 

A computed optimal path location (described by its linear segments) may differ from the true 
optimal path location. Such errors may be so small that the characteristic behavior (for example, the sequence 
of boundary edges crossed between start and goal) of both computed and true optimal paths are identical. On 
the other hand, path location errors can also be very large. Furthermore, large path location errors are 
sometimes caused by relatively small errors in optimal path cost. The reason is simple. A single WRP instance 
can have two distinctly different solutions paths whose total weighted costs are equal and globally minimum. 
The solution path returned by an algorithm will be that for which path cost was most favorable. Thus, if the 
average error in path cost is large relative to precision, then more solutions have the potential to be selected 
as optimal due to error. Assuming that only one in this set is the true optimal, then the probability of selecting 


it is dependent upon the level of noise. 


2 


3. Search Techniques 
There are many ways to classify search techniques. Furthermore, unions and intersections of these 
methods form a variety of combinations. We find it most appropriate to discuss search under two general 


categories — systematic and local. When pertinent, we also mention important subclasses and variants. 


a. Systematic Discrete Search 


Globally optimal solutions of a WRP instance can only be recognized by demonstrating that 
no other feasible solution can have lower cost. This requires a search strategy which is both complete and non- 
repetitious [Pear84]. Completeness says that no optimal solution can be overlooked. Non-repetition precludes 
endless reevaluation of locations previously visited (as can happen in cyclic graphs). In general, a systematic 
search ensures both conditions. 

Uniform breadth-first search is one such complete strategy [Barr81]. Itexpands from the start 
state in all directions accumulating cost at a uniform rate while maintaining a historical trail which links every 
child state back to its opumal parent. There is an implicit ordering of state expansion. As it is encountered, 
each new State is queued on an agenda. Thus, a roughly circular search frontier, represented by the agenda, 
begins at the start state and gradually expands outward as the search progresses. Explored states are marked 
as visited so that they can be identified if revisited. If a partial solution is extended to a state which was 
reached earlier, then the historical data is updated to point back along the shorter approach path. A search Is 
said to be uniform with respect to cost if all partial solution paths are extended by the same cost increment. 
Uniformity guarantees that the least-cost solution has been discovered as soon as the goal is reached. There 
are two major drawbacks to uniform breadth-first search. First, it is a blind search because it does not use 
information about the search space or the problem instance to guide exploration. Second, the incremental cost 
step at which node expansions must occur is a function of the lowest cost coefficient. If the range of cost 
coefficient values is large, then the rate of expansion through higher-cost regions can be painfully slow. 

In some problems execution times can be reduced through bidirectional search. In this 
variant, a search is conducted from both the start and the goal concurrently. If each search by itself is uniform, 
then when a path from the start reaches a path from the goal, their union is the least-cost solution path. 
Application of this technique requires a priori knowledge of the goal location. This being the case in the 
WRP, bidirectional uniform search can be applied to shorten the execution time [Rich87]. 

Branch-and-bound is one search variant which avoids some weaknesses of uniform search. 


This is considered a form of ordered search [Barr81], because there is an explicit ordering of state 
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expansions, tnstead of quenmmny states, brinch-and-bonnd abways expands the state: whose current 
secummobited path cast is minim, This ordering guarantices that an opaimal solution has been found when 
a path ta the goal with a cost thatis equal to or tower than the minimum cost state currently on the agenda 
(i.e. the next state to be explored) is discovered, The first complete solution provides an upper bound on the 
loust-cost solution, Intermediate search nodes whose Cost equals or excecds this bound cannot result in an 
Optimal solution, and, therefore, can be prined from the search. When the bounding mechamsm can be 
activated, and how effective it will be, depends upon how quickly the First solntion is found and how close 1 
is to Optimal, Using accumulated path-cost, brinch-and-bound focuses tts attention on paths which tend to 
have miore potential for optimality. However, the measurement of this potential is one-sided because it is 
mhaitive tothe start state only, Untortanately, when the search graph consists of weighted arcs, then expansion 
af states wall not be umiform with respeet to cost, Therefore, braneh-and: bound cannot employ bidirectional 
search to find a teast-cost soliton, 

A® search is a heurste search variant which extends the concept of branch-and-bound by 
improving the measurement of optimality potential, Each state placed on the agenda is mited by the vatue of 
is evaluation funcoon [BarSt]. The evaluation tinetion ts the sunt of the cost to reach that state trom the 
Start plus an estimated cost from that state to the goal, At each stage im the search, the neat state selected for 
eypansion is the One which has the minimim evalnation., Furthermore, uf the estimate to the goat is a 
guaranteed nnderestimate, then the search is called advusstble, Admissibility guarantees the optimality of the 
first path reaching the goat. Since A* ts more infomed it often demonstrates marked improvement over 
uniformed strategies, Thus, i good cost underestimates are easy to compute, then A* may be preferred over 
brane h-and-bound and unifonn breadth-tirst search, 

Clearty, we desire to employ the fastest, Most cfticient search strategy available, We note that 
both braneh-and-bound and A®* search eheit a price for their efficieney, Both require the maintenance of an 
ordered agenda in the form of a list or heap, Sinee an agenda contains the costs and locations of all partial 
solutions, it cannot be truncated before at feast one complete solution has been found, Otherwise, information 
necesxiry to detemune an optimal solugon may be lost. Agenda control mechanisms can become unwieldy 
for large problems. Thus, if a good underestimate of cost from cach state to the gaal is not easily computed, 
or is NO reasonably close fo actual cost, then A* search may require More Compiting resources than simpler 
tvhnignes [RichS7], From a pracneal standpomt, the best search technique for a given problem ultimately 
depends upon a number of factocs, These include problem domain, representation scheme, solution space, and 


the instaness we expert fo encounter, 
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b. Local Iterative Search 

One of the most powerful and successful techniques for attacking difficult combinatorial 
optimization problems is local search {[Papa82]. In continuous function optimization, local search techniques 
are referred to as steepest descent (minimization) or hill-climbing (maximization) [Barr81]. Researchers have 
applied these searches quite successfully to many NP-hard problems (for example, Traveling Salesman 
Problem [Lin65]). They are also valuable for some polynomial-time-solvable problems. For example, though 
linear programming is polynomially solvable, it can be solved efficiently and exactly by the well-known 
Simplex Algorithm, which is essentially a local search. 

Given the set of all feasible solutions, F, local search requires an initial solution, i e€ F,and 
a mechanism for generating a neighborhood, N, of solutions i. The neighborhood of a solution f is a set 
solutions, fis which are "close" to f [Papa82]. In general, a solution 1b is in the neighborhood of f,, if starting 
from f,, we can obtain i, by some small predetermined change to f ie This change (or changes) is usually 
applied to some representation of the solution i (for example, a simple swapping of two integers represenung 
ordered points in space). How the f. are generated determines the size and content of N. Beginning from Sy 
local search procedure applies and evaluates perturbations to the current solution in an attempt to find cost- 
improving configurations. In iterative improvement only cost-improving perturbations are accepted and the 
procedure repeats until no improvement can be found. At this point the current solution is locally optimal with 
respect to its current neighborhood. The drawback for many problems is that this local minimum may be far 
from the global minimum, with respect to both cost and physical location. 

If the complete cost function of a problem is convex, then local search can always find the 
globally optimal solution. A function f(x) 1s said to be convex if the following inequality holds for any pair 
of domain values, x , and x, [Baza77]: 

V Ae [0,1] fx, + (1-A)x,) < Mix.) + (1-A)fix,) (Eq 2.1) 
Convexity implies that a local extremum is a global extremum. By successively searching the neighborhood 
of the improved solutions, a local search procedure eventually enters the neighborhood of the globally 
Optimal solution. The speed of approach depends on the size of the neighborhood, and how quickly its local 
minimum can be found. In the worst case such a procedure can be very slow. But if the cost function of the 
solution space is a convex function, then faster techniques such as binary or Golden Ratio search can be 
used. 

Not all problems exhibit the property of convexity. A solution space may consist of multiple 


local extrema. Taken as a whole, the solution space of the WRP is not convex. However, recall that it can be 
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partitioned into Convex subspaces. The cost of the local minimum in cach subspace can be found by binary 
search and compared with each other to determine the global minimum. The difficulty with this ts that the 
namber of path subspaces is at least O(2") where v is the number of vertices. Either a way must be found to 
organize these subspaces for systematic search, or a local scarch must be capable of escaping from local 
MUNIN. 

A significant issue in local search is the configuration of a neighborhood and, consequently, 
how it is generated. For a given neighborhood structure, when a locally optimal solution is also guaranteed 
to be globally optimal, then the neighborhood is said to be exact [Papa82]. If the functional value of a domain 
point is better than all other domain points within its neighborhood, then the point is locally optimal. If the 
neighborhood ts exact, then this point 1s also globally opumal. For a convex function, any non-cmpty 
neighborhood ts exact. However, for a non-convex function this is usually not rue. Consequently, only very 
large neighborhoods may be exact. Unfortunately, mm some non-convex problems the only exact 
neighborhoods contain all feasible soluuions (for example, the Traveling Salesman Problem). In such cases 
local search will reqnire the same or more work than systematic search, Therefore, from a pracucal point of 
view, IL Is sometmes better to Compromise an exact neighborhood for an inexact one and concede the 
guarantee of global optimality. Using inexact neighborhoods we can also search locally from several initial 
feasible solutions. This can sometimes be more effective because tt tends to broaden search space coverage. 
However, this does not ensure that the globally optimal solution lics tn or can be located from any 
neighborhood of the initial solutions selected. 

Another important tssue is local search control, the method by which a neighborhood ts 
searched. One common technique, steepest descent examines the entire neighborhood, NV, of some solution 
and selects the locally best soluuon within N. This best solution has tts own corresponding neighborhood, 
Which is searched for ts local extremum. And the process iteratively repeats itself. A more expedient method, 
first-improvement, searches the neighborhood as follows. Given a solution, neighbors are examined randomly 
or in some order until the first cost-improving solution is found. This sotution is used as the basis for the next 
neighborhood. These two techniques generally represent the extremes in a spectrum of vanations on 
neighborhood search [Papa$2). 

The nature of the solution space will Itkely influence the choice of a specific control 
procedure. When a neighborhood structure is relatively small and imparts a natural ordering to its solutions, 
then orderly examination of the neighborhood may be all that is necessary to locate the local optimum. 


However, for some problems exact neighborhoods may be so large that only partial search is practical. In such 
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cases, random sampling within the neighborhood can be useful and more efficient. As in systematic search, 
heunisuc information can often help to reduce local search. For example, in his work on the Traveling 
Salesman Problem [Lin65] recognized that it is sometimes possible to identify common features of good 
solutions. The heuristic is that some of these features are very likely contained in the global optimal solution. 
To apply this knowledge, a local search should tend to preserve these features in subsequent neighborhoods, 
thereby reducing the overall search effort. 

The steepest descent approach to the WRP would encounter difficulty with discontinuous 
costs between path subspaces which occur at region vertices. The convexity theorem guarantees path-cost 
continuity for path subspaces which cross identically ordered sequences of boundary edges. It does not apply 
when the sequence of edges crossed changes, as occurs if a path subspace includes a vertex joining regions 


of unequal cost coefficients. 


c. Relaxation 

Many optimization problems reduce to finding the solution which best satisfies a large set of 
conflicting constraints, that is conditions required of the solution. A search technique in which constraints are 
iteratively added, removed, or replaced to improve a solution is called relaxation. The term has been applied 
to both continuous (Char87] and discrete [Rowe88] optimization. We say that a constraint is active when it 
is currently being enforced. Otherwise, it is relaxed. We may begin from one solution and activate one or 
more constraints which require that the original solution be changed to satisfy the new conditions. Another 
method begins by assuming that all solutions are possible. As constraints are activated, solutions which 
cannot satisfy them are eliminated. As more constraints become active they may or may not conflict. If they 
do, it may be necessary to backtrack, relaxing some and activating others. The entire process can be viewed 
as a State space search where states are solutions satisfying various constraint combinations and/or degrees of 


restriction. 


d. Probabilistic Search 
If neighborhoods or problem instances are too large for practical exploration, then a 
probabilistic approach to search becomes appealing. There are several forms of probabilistic algorithms. A 
Monte Carlo algorithm returns a solution which has some probability of being correct. A Las Vegas algorithm 
always finds a correct solution, but may require multiple executions to do so [Bras88]. Another form of 


probabilistic algorithm estimates a solution when an exact solution is not possible or is impractical. 
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Our approach to solving the WRP tends toward probabilistic estimation. We rapidly sample 
locally optimal solutions randomly by moving through neighborhoods consisung of convex path subspaces. 
The cost of a subspace is the cost of its locally optimal path. Cumulatively, the sampling covers a broad area 
of the solution space. Probability focuses local search on the neighborhoods with greater potential for 
contamimg an optimal path. Gradually, we reduce the ability of the algorithm to sample across a broad range 
of path subspaces. This is done by decreasing the probability of movement to cost-increasing solutions. 
Inevitably, the probability constraints ughten to the pornt of preventing movement to all but cost-improving 
solutions. When all cost improvements have been applied, the algorithm halts and delivers its best known 
solution, 

While probabilisuc algonthms cannot guarantee globally optimal solutions, the practical 
advantages can be signifteant. Probabilistic algorithms are inherently nondeteministic. Two execution 
sequenees on the same problem instance will almost never be identical, although the final solutions can often 
be the same. Such behavior tmplies that fora given problem size algorithm performance does not depend on 
aspeciftc problem instance, In probabilistic algorithms expected time of execution replaces average execution 
{ime Over all possible instances of a pantcular stze. For a given problem size, expected execuuion time is the 
same tor all problem instances — worst cases included. In this sense, one can argue that probabilistic 
algonthms can exhibit more predictable performance than deterministic ones. 

A typical behavior of many probabilistic algorithms is that the quality of their final soluaons 
can improve over ame, This can be a significant advantage when time resources are uncertain. Such 
alzonthms might be tenminated prematurely and still retum an adequate result. The most obvious time 
advantage Occurs because a probabilisuc algonthm merely samples its solution space and uses statistics and 
heuristics to mterpolate and infer knowledge. Often global or near-global optima can be found in significantly 
less computing ime. Thus, a relauvely small sacrifice in solution quality can deliver a disproportionately 


large increase in efficiency. 
B. APPROACHES TO THE GENERAL WEIGHTED REGION PROBLEM 


l.  Grid-Based Wavefront Propagation 
Wavefront propagation is an approximating method which employs a modified branch-and-bound 
search. An orthogonal gnd of predetermined resolution overlays a weighted-region map. Each grid cell is 
assigned a cost coefficient. There are at least two ways to do this. We could use the homogencous-cost 


coefficient of the region occupying the greatest area within the cell. We could also take the average cost 
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coefficient weighted by the percentage of its area in the cell. The search begins from the grid cell containing 
the start point and continues until the cell containing the goal point is reached. A trail of back pointers permits 
optimal path retrieval. An agenda maintains the wave frontier and associated back pointers. Although simple, 
the algorithm has three major drawbacks. First, it is a blind search. Thus, without heuristics, it is painfully 
slow, particularly if the range of cost coefficients is large. Second, even maps with a few regions may require 
a relatively high resolution grid to accurately represent detail. Each cell of the grid is essentially a node in the 
search graph. Increasing the resolution of the grid by factor R roughly induces an R’ increase in the number 
of search nodes, and, consequently, the size of the problem instance. Third, fixing paths to a grid causes "stair- 
step" solution paths. Assuming that resolution is fine enough to capture all terrain features modeled by the 
weighted-region map, an 8-neighbor implementation, may return solutions which are as much as 8% greater 
than optimal. Nevertheless, digital bias can be reduced [Mitc84], and heuristics can improve efficiency to 


some degree [Rich87). 


2. Snell’s Law 

More accurate approaches to solving the WRP use Snell’s Law as a local optumization criterion. 
Recall that cost regions are homogencous. Thus, by the triangle inequality, optimal paths cannot tum at 
interior points of cost regions. It follows that turning points may occur where cost changes abruptly, that is, 
at cost region boundary edges. 

Snell’s Law defines the optimality conditions for such tums. Given a fixed point in each of two 
adjacent regions, the least cost path between them always satisfies the conditions of Figure 2.2, where 0 ] and 
0, are region cost coefficients. This relation is analogous to that used in optics to determine how a light ray 


will bend when it passes between two media with different refraction indexes. 
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Figure 2.2 Snell’s Law Optimality Criterion 


The optical analogy is less applicable in the limiting case of reflection. Figure 2.3 illustrates the 
special case of a crossing episode which occurs at the Snell’s Law critical angle associated with the higher 
cost region. An optical light ray reflects back into the medium from which it came when its angle of incidence 
exceeds the critical angle. Such a path would not be optimal in the WRP. To preserve optimality requires that 
the path move parallel and infinitesimally close to the boundary edge on the low cost side. Thus, the path 


incurs the lower cost per unit distance of travel on the edge. 
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Figure 2.3. Snell’s Law Critical Angle Crossing 


20 


Previous research suggests that Sncll’s Law is a powerful concept for the WRP. However, there 
are also some limitations and difficulties with its use. Snell’s Law defines local optimization criteria only. It 
is a necessary but not sufficient condition for optimality at boundary crossings. Therefore, a globally optimal 
solution path must obey Snell’s Law at every boundary crossing episode (except at vertices). However, a path 
which satisfies Snell’s Law at every crossing episode is not guaranteed to be globally optimal. Depending 
upon how it is used, the relation may not be convenient to compute. While Snell’s Law can compute required 
angles directly, there is no closed form for computing the coordinates of crossing points. Furthermore, it 


involves the sine function (or square roots in other forms), a relatively primitive but expensive operation. 


3. Continuous Dijkstra Algorithm 
The continuous Dijkstra algorithm [Mitc90] propagates Sncll’s Law constraint intervals in all 
directions from the start. A branch-and-bound procedure searches the graph representing these intervals. This 
algorithm finds the true optimal path, and establishes a worst case O(v’L) time complexity and Ov’) space 
complexity (where v is the number of region vertices and L is the number of bits used to represent input). 
While establishing that the WRP is polynomially solvable, the algorithm’s current lack of implementation 
prevents practical comparison. Indeed, its seventh-degree-polynomial-time complexity and its requirement 


for triangulated cost regions, suggest that it will have relatively large average execution times. 


4. Recursive Wedge Decomposition Algorithm 


Another algorithm which finds an optimal path to the WRP is the recursive wedge decomposition 
algorithm implemented by [Rowe90b]. The algorithm propagates well-bchaved sets of paths (referred to as 
wedges) from the start point, and recursively expands and refines them to construct a graph of shortest paths. 
These wedges are similar to the constraint intervals in [Mitc90]. A prototype implementation has 
demonstrated Ov’) average time complexity for relatively simple terrain (although worst case is still 
exponential). The algorithm tends toward its exponential worst case when a large number of wedges overlap 
the goal [Rich87]. It is a very complicated algorithm which uses trigonometric functions for many heading 
and visibility computations. Furthermore, its recursive nature can magnify the effects of these computations 
and increase the amount of agenda maintenance necessary as the size of a problem instance expands. 
Although, pruning heuristics do help to control these effects. The empirical performance of this algorithm in 


more complex terrain maps (with a wide range of cost coefficients and many contiguous regions) is unknown. 
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5. Local, Asynchronous, Iterative, and Parallel Procedures (LAIPP) 

The only known work that does not use some type of systematic search is [Smit88]. The Local, 
Asynchronous, Iterative, and Parallel Procedures (LAIPP) approach is a form of relaxation. It is similar to a 
neural network simulation executed on a single processor system. A hypothetical processor is assumed at each 
boundary edge of the map. A boundary edge faces the two regions it borders. Its associated processor 
communicates with each processor assigned to the other boundary edges of the two regions it faces. Each 
processor tracks the locations of several path crossing points on its edge. For each point, the processor records 
what it believes is correct local and global weighted distance data relative to start and goal. The processors 
iteratively and asynchronously exchange and modify the data. Eventually all processors converge to an 
agreement on locally and globally optimal path data. At least one serial set of processors from start to goal 
has recorded identical (within tolerance) lengths for the solution path on which they lie. A systematic search 
of the discrete graph defined by serial chains of agreeing processors 1s searched for the shortest such path from 
start to goal. Although empirical results indicate that the procedure often converges to an exact globally 
optimal path, it is not guaranteed to do so. Furthermore, many locally minimal paths can be far from optimum. 
The empirical time complexity 1s measured as the number of iterations required for convergence to processor 
agreement. This complexity is slightly more than linear as a function of Euclidean path length. Time 
complexity is also dependent upon the range of cost coefficients used. LAIPP is an interesting and promising 


approach which we believe will prove most valuable in a parallel processing environment. 


6. Optimal-Path Maps 

An interesting approach proposed by [Alex90] attempts to solve a large number of WRP instances 
at once. For a single goal point location and the geometry of weighted regions, the plane can be partitioned 
into behavioral regions. These are areas in which optimal paths from all other points behave in a similar 
manner. For example, all optimal paths from start points in a given partion might travel directly to and pass 
through the same weighted region vertex enroute to the goal. Given enough preprocessing time, complete 
Optumal path maps can be constructed. An efficient storage scheme will enable fast subsequent computing of 
any optimal path. 

Two different approaches are proposed for constructing behavioral regions. The first is a 
specialized grid-based wavefront propagation algorithm modified to recognize points on behavioral region 


boundaries. These are recognized as the locations of wavefront convergence, points from which two (or more) 
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distinctly different paths exist which return to the goal at identical costs. This algorithm suffers from the usual 
inefficiencies and inaccuracies associated with grid-based wavefront propagation. 

The second approach is an elegant application of computational geometry. It is based on the 
observation that in a constant weighted plane (i.e. a single cost coefficient on the entire map) the optimal-path 
cost function originating from a common goal sweeps the surface of a perfect cone. The introduction of 
weighted regions perturbs this cost function, and, thus, the shape of this cone. In simple maps, the behavioral 
region boundaries formed by these perturbations can be computed as straight lines and conic section curves. 
The algorithm applies complicated parametric equations to find the conic curves. The computations are 
tedious and expensive, but the result is a complete and concise optimal path map from a given start (goal) to 
any goal (start) point desired. 

To determine behavioral regions more efficienuy, [Rowe90e] suggests modifications to the 
recursive wedge decomposition algorithm of [Rich87]. The algorithm’s A* search strategy can be exploited 
to recursively partition a map into a tree of wedges rooted at the designated start point. A few conditions 
determine the possible locations of overlapping wedges. Standard polygon-intersection procedures can check 
these wedges for true overlap, and, if found, establish the shape of conic behavioral region boundaries therein. 
A prototype of this algorithm is currently under development. While this algorithm builds optimal-path maps 
more efficiently than those of [Alex90], the time investment is too costly for single start-to-goal paths. 

Ideas presented in this dissertation could be used to improve the retrieval of optimal paths from 
the optimal-path-map storage structure proposed in [Alex90]. An optimal-path map is stored as tree of 
behavioral regions which are linked back to acommon goal point (the tree root) by the vertices and boundary 
edges through which optimal paths must pass. Given a start point, its associated optimal path to the goal 1s 
found by tracing the ordered sequence of edges and vertices which are its ancestors in the tree. This sequence 
may require some limited optimization to obtain the exact path. Methods presented in this work can perform 


this optimization efficiently. 


7. Minimum-Energy Paths 
The work of [Ross89] and [Rowe90c] established a model for finding minimum-energy paths over 
terrain modeled by disjoint polygonal regions representing constant-slope surfaces. Such a terrain model is 
sometimes said to represent 2-1/2 dimensions because freedom of movement is restricted to a 3 dimensional 
surface. Follow-on work [Rowe90e] proposes an integration of both this model and concepts developed in 


[Rich87]. This research extends the generalized WRP to incorporate anisotropic homogeneous-cost regions. 
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The proposed unified algorithm solves a WRP in the 2-1/2 dimensional terrain model where region weights 
are coefficients of friction. An optimal solution in this problem is the minimum energy path from start to goal 
(or minimum tume-travel path under constant power). 

The original implementation of the algorithm partitions the map representation into subspaces in 
which families of paths exist. Our approach to the WRP uses a similar partitioning of the map. However, all 
of our WRP subspaces are naturally bounded by vertices and boundary edges. The model of [Ross89] requires 
the additional consideration of directional constraints which may further restrict the shapes and limits of 
subspaces. These constraints must be examined and correlated in order to form complete path subspaces from 


start to goal. This additional complexity is absent from the two-dimensional isotropic WRP. 


C. SPECIAL CASES OF THE WEIGHTED REGION PROBLEM 


Some applications may only require an easily solved special case of the WRP. We briefly consider two 
algorithms designed to solve instances in which terrain features represcntation is restricted. The algorithms 
are similar in that cach constructs a form of discrete visibility graph from spatial constraints. The concept of 
visibility Occurs often in movement planning. While its meaning may vary with problem context, visibility 
generally implies that at least one unobstructed-straight-line path exists between two points on a map. As the 
following special cases indicate, visibility analysis can often derive many powerful constraints on optimal 


paths. 


1. Infinity, Zero-cost Regions, and Roads 


The algonthm in (Mitc87] solves a special case WRP in which we restrict terrain features to four 
types: background, zero-cost regions, roads, and obstacles. As usual, obstacles are non-traversable areas of 
infinite cost. Zero-cost regions are areas in which travel incurs negligible cost regardless of distance 
(essentially, movement at infinite speed). Cost per unit distance in background terrain is taken as one. 
Although fixed, this value can be arbitrary. Roads are strictly linear features whose cost per unit distance is 
less than background cost. Given a start and goal, the algorithm computes a special visibility graph of all 
possible optimal path locations. These locations are determined through visibility analysis between vertices, 
and by applying the Sncll’s Law local optimality critcrion. The resulung graph is provably finite, and can be 
searched using standard graph search techniques. The algorithm has worst case O(n*logn) time complexity, 
where n is the number of feature vertices. This is a significant improvement over the seventh-degree- 


polynomial time complexity of the continuous Dijkstra algorithm. 
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Our approach to the generalized WRP makes an important assumption related to visibility about 
the input map. The fact that all regions are convex (or can be made so with additional boundary edges) means 
that all edges bounding a given region are completely visible to one another without further calculation. This 


removes the need for visibility analysis between end points of path segments. 


2. Roads, Rivers, and Rocks Algorithm 

Additional work by [Rowe90a] extends the foregoing ideas to rivers, linear features with a higher 
cost than background terrain. While the work does not consider zero-cost regions, it is a valuable extension 
because roads, rivers, and obstacles can model a great number of commonly encountered terrain situations. 
Proof is given that optimal paths can only cross rivers at single points and, unlike roads, will never travel on 
them. Since the width of a linear feature is zero, then each river crossing episode incurs a fixed value, k, which 
is added directly to total path cost. The RRR (Rocks, Rivers, Roads) program is a Prolog implementation of 
the algorithm. RRR develops a special visibility graph similar to that in [Mitc90]. As a result, worst case time 
complexity remains O(n’ logn). However, RRR also uses several spatial heuristics along with A* search to 
improve average case performance. The so-called shortcut meta-heuristic [Rowe90a] is proposed as the 
unifying concept for all optimal path constraints. Related to the optimality principle, the Shortcut Mcta- 
Heuristic simply implies that a turning point on an optimal path can never be improved by shortcutting the 
turn. In our own work, we employ this concept to generalize optimal path constraints between regional 


boundary edges. Such constraints were first applied in limited form as heuristics by [Rich87]. 


D. SIMULATED ANNEALING 


Simulated annealing is a search technique based upon the Metropolis Algorithm [Metr53], which 
simulates a complex system of particles (molecules) in a heat bath. Recognizing concepts similar to 
optimization, [Kirk83] and [Cern85] independently developed simulated annealing. Since then, many 


researchers have used it to obtain solutions to a variety of combinatorial optimization problems. 


1. The Basic Annealing Algorithm 
In its simplest form, simulated annealing requires the five basic components described in Figure 
2.4. Starting from the initial solution and its evaluated cost, a move generator randomly perturbs this solution 
to obtain a new neighboring solution. The cost function of the new solution is computed and compared to the 


cost of the current solution. The new solution always becomes the current solution if the change in cost, AC, 


25 


is an improvement. Otherwise, the new solution becomes the current with probability P=exp(-AC/T). Figure 


2.5 shows the form of the algorithm we use in this work [Pres88]. 


. Solution space definition 


. S,- Initial solution taken from the solution space 


. Move generator to randomly generate small perturbations in 
solutions, thereby inducing a neighborhood structure to the 
search space 


. C{(S) - Cost function which can be evaluated for each solution 


. Annealing schedule to provide algorithm control: 
Initial value of T 
Freezing value of T 
Reduction factor for T (typically 0.70 < R< 0.99) 
Maximum number of attempted moves at T 
Maximum number of accepted moves at T 





Figure 2.4 Basic Components of Simulated Annealing 


initialize CURRENT starting solution 
initialize T := To /* Tg starting temperature */ 
while (T > T;) do /x until T reaches T; freezing value */ 
fori:=1toL /* for L attempted transitions */ 
perturb CURRENT to generate NEW solution 
AC := cost(NEW) — cost(CURRENT) 
if (AC <Q) 


then CURRENT := NEW 
else CURRENT := NEW with P = exp(—AC/T) 
end for 
T:=R*T /* decrement T by reduction factor R */ 
end while 
return CURRENT solution 





Figure 2.5 Standard Simulated Annealing Algorithm 
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The control temperature, 7, is a value in the same units as the cost function. It regulates the 
probability distribution that defines the acceptance criteria of soluuions with degrading costs. At each 
temperature, 7, the procedure attempts up to L moves of which up to L. acceptances are permitted. Then, the 
temperature is reduced by a factor RX, and both L and L. are reset. The resulting behavior is a downward-biased 
random walk through the solution space, with some ability to escape local minima. Referring to Figure 2.6, 
itis easy to see that gradually decreasing control temperature changes the exponential probability distribution. 
tightening the acceptance criteria against larger cost increases. The value of 7 for which no cost increases are 
reasonably expected and no more improvements can be found 1s called the freezing temperature, T. At this 


stage the algorithm returns the most current solution, and halts. As an added advantage, the algorithm can also 


maintain the best known solution and retum this if it is better than the final current solution. 
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Figure 2.6 Probability of Acceptance vs Cost Difference AC 
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To enhance the performance of the basic annealing algorithm, researchers have developed and 
tested a variety of improvement techniques and heuristics. All of these methods are concemed with one or 
more of the basic annealing components. Since the focus of our work is in solving the WRP using annealing 
as a tool, we defer discussion of enhancements to Chapter IV. To the best of our knowledge, the work of this 
dissertation is the first (and only) investigation of a Simulated annealing algorithm to solve the WRP. 

In the sections which follow, we review some of the previous annealing work applied to problems 
with a path-planning flavor bearing some resemblance to the WRP. Our objective is to identify and discuss 
similarities and differences between these problems and the WRP as they relate to annealing. For annealing 
work on other problems and applications, [Coll88] gives an extensive annotated bibliography of simulated 


annealing theory and applications. 
2. Routing Applications of Annealing 


a. The Traveling Salesman Problem (TSP) 


The classical Traveling Salesman Problem (TSP) is arguably one of the most investigated 
problems on record. Because it is NP-Complete, large instances of the TSP are likely to be intractable and 
require approximating algorithms to estimate the optimal solution. As a result, many researchers have 
explored annealing solutions to it. In addition to the original work of [Kirk83] and [Cern85], [Coll88] lists 40 
references to annealing work on the TSP. Most of this work uses the TSP as a vehicle to investigate properties 
and enhancements to the annealing algonthm itself. While both TSP and WRP are essentially routing 
problems in two-dimensional Euclidean space, there exist significant differences which impact on the 
annealing approach. 

The TSP admits a fairly straight forward annealing approach. In its classic form, a TSP 
instance consists of a finite set of discrete points in a two-dimensional plane. The optimal solution is a 
piecewise linear least-cost path which connects every discrete point with a straight-line path segment. The 
enure path forms a closed cycle. Thus, every feasible solution is well-defined, includes every input point 
once, and has a cost which is almost precisely determinable. These three aspects of the TSP make it an 
excellent annealing application. Solutions are nothing more than a fixed-length ordered set of points. A 
solution cost is the sum of Euclidean distances between ordered points. The move generator for the annealing 
algorithm is simple and efficient. To generate a new feasible solution, permute the point ordering of the 


Current solution. 
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In contrast, an annealing approach to the WRP is more difficult. A problem instance is a map 
of regions, associated cost coefficients, and designated start and goal points. The number of feasible solutions 
between start and goal is uncountably infinite. Fortunately, the convexity of the Snell’s Law optimality 
criterion can parution the solution space into a finite number of discrete path subspaces (recall the wedges in 
[Rich87]). Even so, computation of a single cost for each subset of paths can be expensive and highly 
dependent upon desired precision [Mitc90]. WRP feasible solutions usually consist of some subset of 
problem input; generation of new feasible solutions is not as simple as permuting a fixed-length list. Finally, 
recall that annealing requires an initial solution to begin. While a TSP initial solution is any ordering of the 
input, such is not the case for the WRP. A straight line path from start to goal is not guaranteed to be feasible 
in the presence of infinite cost regions. Thus, we must also resort to a more sophisticated method to initiate 
annealing for the WRP. 

An annealing-based algorithm to solve a more general variation of the TSP is presented in 
[Adam85]. The problem is to plan an ordered cyclic route from a given Starting point to a subset of 
predetermined locations on a two-dimensional map. The objective cost function is considerably more 
complex than simple Euclidean distance. Each location 7 has a corresponding value V.. which measures its 
worth to the overall plan. Subgoal values We can be dependent upon time and interdependent upon order of 
arrival. The objective function also employs the conditional probability, PIG JS}, of reaching a subgoal i, 
given that the plan / is pursued and given the current state S of the autonomous vehicle (e.g. fuel supply, 
weapons Status) and its working environment. Constraints of minimum acceptable probabilities and minimum 
time required to reach particular subgoals may also factor into the cost of a plan. The algorithm searches for 


a plan which maximizes overall utility defined as: 
Loos a0 [G;| S1V;,) (Eq 2.2) 

One similarity between this problem and the WRP concems cost function evaluation. Recall 
that in annealing, cost function comparisons between solutions drive and guide the process. Clearly, exact 
evaluation of each feasible solution is not reasonable in the algorithm of {Adam85]. Instead, the authors adopt 
a Monte Carlo method to approximate the cost of each solution, which significantly increases algorithm 
efficiency. A similar time-saving technique suggested by [Tove88] is the surrogate function swindle. If acost 


function is difficult to evaluate, substitute one which is easier and approximates the original. In the WRP, 


Snell’s Law enables us to compute locally optimal path costs. However the nature of Snell’s Law makes the 
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procedures for doing so relatively expensive. Consequently, we approximate their costs as often as possible, 


reserving the more precise computations only when absolutely necessary. 


b. Wire Routing and Chip Placement 

The design of very-large-scale integrated circuit boards requires the optimal placement of 
solid state chips and associated wire connections. Simulated annealing has been successfully used in the chip 
placement problem [Grov86, Sech86], a direct descendent of the NP-complete bin packing problem. Global 
wire routing is a path optimization problem somewhat closer in similarity to the WRP. While the problem 
context is a two-dimensional plane, wire routing solutions are usually drawn from a discrete space of 
predetermined routes. Ordinarily, an optimal arrangement of components predetermines all terminal points 
for connecting wires. An optimal routing of wires required between all terminal pairs minimizes total distance 
and the number of bends and overlaps [Vech83}]. In global wire routing, the routes are normally confined to 
the orthogonal channels between components, so that the Manhattan distance metric applies and the solution 
space is discrete. Also, there 1s usually some upper bound constraint on the overlap capacity of each channel 
(i.e. the maximum allowable number of tracks per channel). 

Like the Traveling Salesman Problem, the global wire routing problem lacks the continuous 
space aspect that complicates the WRP. However, wire routing exhibits a more complicated objective 
function. The objective function of [Vech83] attempts to mode] all constraints simultaneously. Annealing is 
conducted in two stages. The first permits only L-shaped paths (single bend) between terminal points. The 
second stage begins at the temperature from the last state of stage one, and includes both L and Z-shaped paths 
(two bends). Staging the optimization in two shifts reduces overall computing time yet achieves results 
comparable to those obtained when both path types are sampled throughout the entire annealing process. 
Similarly, [Sech86] employs a two-stage approach. However, the first stage 1s a non-annealing algorithm 
which selects wiring configurations that minimize only total distance. The second stage uses annealing to 
minimize total wire overlap by searching through the choices made by the first stage. Again, the result is 
savings of ume. 

A multi-stage approach is often applied to difficult problems. The strategy attempts to 
identify high-level characteristics common to most optimal or near-optimal solutions (for example, general 
shapes, common placements, etc.) that can later guide development and optimization of a more detailed 
solution. This strategy is formalized in [Whit84] by relating the scaling of moves to annealing temperature. 


At higher temperatures, larger random moves through the solution space are more efficient than smaller 
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moves. Detailed solution improvements are discovered at lower tempcratures, when smaller moves are most 
efficient. In this sense, simulated annealing develops a solution in a top-down manner. Evidently, because of 
this similarity, multi-staging seems to be a good general-purpose annealing heuristic. 

Closely related to multiple stages is concept of the target prejudice swindle suggested by 
{Tove88]. This applies when general characteristics or properties of optimal solutions are known. The 
annealing process often saves time if the the move generator can be biased to generate neighbors with optimal 
solution characteristics. For example, in the WRP we know that optimal solutions never have cycles. 
Therefore, we should avoid generating such paths. In the extreme sense, this is what [Vech83] has done by 
biasing his first stage exclusively toward L-shaped paths. Another simple way to get the effect of the target 
prejudice swindle heuristic is to begin with a reasonably good initial solution. In the [Sech86] algorithm, the 
non-annealing first stage selects a large number of good starting solutions. This effectively provides the 
second stage (annealing) with a boost. Thus, stage two does not waste time examining poor solutions just to 
identify better ones. 

We find that staging concepts are also applicable to our annealing-based algorithm for the 
WRP. Our current implementation finds one good initial starting solution from which to begin annealing. 
However, several initial starting solutions could improve the performance of the overall algorithm. Chapter 
III discusses how an initial solution is found. In Chapter IV, we suggest how to obtain multiple starting 
solutions might be obtained. Chapter IV also describes heuristics for preconditioning weighted region maps 


to improve path annealing performance. 


c. Robot Arm Movement 


The problem of efficiently and safely moving the end effector of a robot arm through three- 
dimensional space is another path-planning problem to which simulated annealing has been applied. The 
algorithm of {Lind87] uses an octree representation of space in which to plan movement for a manipulator of 
5 or 6 degrees. Simple problem instances are handled by a deterministic algorithm. However, simulated 
annealing tackles the complex cases. Here again, we see a two-stage approach. However, in contrast to 
previously discussed applications, it is the first stage of this algorithm that uses annealing, not the second. The 
first stage finds solutions for movement of the first three links closest to the manipulator base, corresponding 
to Coarse movement. The solutions are near-optimal in the sense that they minimize the link movements 
(torque and translation) required to translate the last three links to the target position in space. The second 


Stage deterministically locates refined solutions for the links closest to the wrist. 
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Another example of an annealing-based algonthm for manipulator arm movement planning 
is found in [Carr90]. This work reports that reasonably good solutions are obtained from relatively simple 
annealing schedules. We have also found such to be the case in our approach to the WRP. Although we 
performed some very limited testing with more elaborate annealing schedules, the best results came from the 


simplest ones. 
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It. PATH ANNEALING DESIGN 


A. INTRODUCTION 

Path annealing is a probabilistic algorithm which combines a fast, crude systematic search with a non- 
exhaustive local search to find near-optimal solutions for the weighted-region problem. This chapter presents 
the basic design concepts for the path annealing algorithm. 

In this chapter we introduce and define many terms and concepts specific to path annealing. Some of 
these concepts refer to supporting theorems which are presented only informally (with intuitive explanations 
as required for immediate understanding). A more formal statement of the theorems and associated proofs is 
contained in Appendix A. 

Since we desired to implement a prototype of path annealing quickly, we chose to use Quintus Prolog 
Release 2.5 [Quin90] as our base language. There were many good reasons for this decision. Prolog code for 
several standard algorithms used in our work (such as A* search) was available through other related research 
projects. Generic Prolog is very high-level and provides automatic backtracking. Furthermore, Quintus 
Prolog provides automatic hashing, compilation, a foreign language interface, and graphic display 
capabilities. All of these facilities were used to develop, debug, and optimize the prototype. Appendix B isa 


complete listing of all source code. 
B. STATE SPACE REPRESENTATION 


1. Window Sequences 


For a WRP instance define the solution space as the collection of all conceivable piecewise linear 
paths between start and goal, whose turning points (between linear segments) occur at regional boundary 
edges or vertices. We omit from this collection all paths with turning points which do not lie on regional 
boundaries because such paths can never be optimal. Furthermore, it is always possible to improve the cost 
of such a path by shortcutting any turning points which occur in region interiors. Note that we do not exclude 
cyclic paths, even though such paths cannot be optimal. WRP solution space contains an uncountably infinite 
number of solutions. The convexity theorem does not apply to the solution space as a whole unless all paths 


between start and goal must cross the same sequence of edges in exactly the same order (a possible, but very 
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unlikely problem instance). Most problem instances contain many path-cost disconunuitics. In order to 
manage such complexity we desire to represent this space in some discrete form. 

Recall from Section I.A.1.c that the primary reasons for representing the WRP search space 
discretely are: (1) to utilize the cost function convexity theorem for paths which cross the same sequences of 
consecutive boundary edges; and (2) to make the problem suitable for combinatorial opumization. We assign 
a umigue integer identifier to cach region boundary cdge. Furthermore, we assign idenufiers s and g to 
designated start and goal points respectively. We now define the concept of window sequence (WS). This 
concept was originally adopted by [Ross89] to describe a family of paths which cross the same sequence of 
boundary edges and vertices and which must obey the same set of movement constraints. Our definition of 
window sequence is similar, but not identical. Consider the continuous, infinite set of all paths between the 
start and goal points which cross the same ordered sequence of edges. We can uniquely label this family of 
paths ustng an ordered list of edge idenufiers. The first and last elements of this list are always s and g 
corresponding to start and goal respectively. Such an ordered set ts called a window sequence. Figure 3.1 is 
an example of a window sequence (WS), Duplicate edge identifiers are permitted within a legitimate WS. 
This simply means thata family of paths must cross the same edge multiple times. Also, note that a WS must 


include every edge identfter that its associated paths cross. Idenufiers may not be skipped in a valid WS list. 





Figure 3.1 Window Sequence 
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Note that a WS is not the same as a wedge [Rich87] as in Figure 2.1. A wedge has a start but no 
terminating point, and consists of only Snell’s Law paths defined betwecn extreme left and right bounding 
paths. In contrast, a WS has both start and terminating points and consists of all paths (regardless of Snell’s 
Law) which cross the given sequence of defining edges. Nevertheless, the convexity theorem of [Rowe90b] 
and {Mitc90] still applies to WS because the theorem places no restriction on edge length and the path-cost 
function remains the same. Therefore, a unique locally optimal path must exist within each WS, and a 
standard conunuous funcuion opumization method can be used to locate it. 

Window sequences partition the WRP solution space into possibly overlapping classes of paths. 
We can idenufy a number of desirable propertics which emphasize the advantages of a window sequence 
representation: 

¢ All WS’s are discretely represented by ordered lists of edge identificrs. 

¢ Assuming a bordered map, the total number of WS’s is finite. 

¢ Every path in the WRP soluuon spacc is contained in some WS. 

« Some WS contains the globally optimal path. 

« Consecutive turning points betwecn path segments are always visible. 
Though finite, the number of states (1.c. window sequences) in this space is very large. However, if we can 
find the locally optimal path of any WS, then we have a means of comparing WS’s. By searching the 
solution space of WS’s we can use these costs to determine optimal or ncar-opumal paths. 

Recall from Section I.B that we assume all regions ina WRP map are convex (with the exception 
of the non-traversable border region). The reason is that a convex-region map subsumes the definition of edge 


visibility. Consecutive edges in a WS are always completely visible to one another, and so, visibility 


computations are unnecessary. This improves the efficiency of determining the locally optimal path in a WS. 


2. Primitive Data Structures and Operations 


In order to form a high-level representation of the solution space we preprocess a WRP map into 
several primitive data structures designed to facilitate rapid navigation through the space at lower levels. Our 
input maps are just a list of boundary edges with defining vertices and associated cost coefficients to either 
side. It is assumed that this list represents a complete set of straight-line segments in a planar graph. 
Henceforth, we refer to this graph as a weighted-region map. The input description of each edge in the map 
conforms to a standard convention. Boundary edge, E, is defined by the sct {v, V5>H,, H}, where ve and v, 
are the coordinates of its terminating vertices, and j and L., are the cost coefficients of the regions it bounds. 


An agent traveling along this edge from v, lov, will always see ., on his left and H, on his nght, when H,< 
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L,. However, if p= Ho» then the x coordinates of the vertices are related as v )@) < v(x). If p=, and v )@) 
= v2), then v 0) < v,0). 

Map preprocessing creates and assigns a unique integer identifier to each edge, and stores it 
together with defining vertices, associated weights, linear equation form, midpoint, length, bounded regions, 
and directional data. This provides extremely efficient access since Quintus Prolog [Quin90] hashes 
predicates on the first atomic argument, in this case the edge identifier. Thus, given a WS of edge identifiers, 
its vertices, regions, and related data are all immediately accessible. 

In addition to the edges themselves, there are two special structures which store knowledge about 
spatial relationships between edges. We create an edge link for each pair of edges which end in the same 
vertex and are adjacent around the same common vertex. For each such edge-pair, the edge link records 
appropriate edge identifiers, the common vertex, and the cost coefficient of the common region bounded by 
the pair. We also create an edge dual-graph which is a high-level data structure representing all WS’s. 
Because it is high-level, we defer discussion of this data structure to the next section. 

Since we desire quick access among edges, vertices, and regions, preprocessing creates several 
data structures which are essenually inverted files indexed on these entities. For each vertex in the map, a 
vertex edge-list is maintained. This data structure stores a clockwise ordered list of edges incident around each 
vertex. Two similar data structures are constructed for regions. A region edge-list holds the associated cost 
coefficient and the ordered list boundary edges for each convex region. A region vertex-list stores the ordered 
list of vertices around each region. As will be explained later, obstacles are treated as though they were special 
oversized vertices. Similar to a vertex edge-list, an obstacle edge-list stores an ordered list of the incident 
edges around each obstacle. 

The geometric nature of the WRP requires a large numbcr of floating point operations. 
Unfortunately, Prolog was not designed for efficient number crunching. Furthermore, Quintus Prolog Release 
2.5 floating point operations are accurate to only 6 decimal digits of precision. To compensate we 
implemented many primitive routines in C, (see Appendix B). particularly floating point operations. These 
are called as Prolog predicates through the foreign language interface. Common routines implemented in C 
include: weighted and unweighted distance computations, random numbcr generation, linear interpolation, 
routines to implement a heap data structure, Golden Ratio and binary search routines, and annealing schedule 
control. 

A few primitive geometric routines are implemented in Prolog. However, we have intentionally 


written these procedures to execute simple arithmetic operations only, avoiding square roots and 
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trigonometry whenever possible. We have also compressed the mathematics in these routines to as few 
operations as possible. Line intersections are taken by solving simultaneous linear equation forms. 
Perpendicular projections are done similarly. For efficiency and accuracy, special cases (e.g. intersections of 
parallel or coincident lines) are intercepted by pattern matching of coordinates and line equation coefficients. 
Then, instead of permitting calculations which might result in great loss of precision, we attempt to solve 
them through spatial reasoning about local geometry. Directional heading computations require a single 
arctangent operation at one stage, and otherwise they involve only arithmetic operations. Again, special cases 


are intercepted and handled separately by spatial reasoning. 


C. INITIAL SOLUTION 

Annealing can begin from any solution in the space. However, empirical evidence suggests that 
reasonably good initial solutions can often provide better final results [Naha86, John89]. The obvious 
straight-line path from start to goal 1s not always feasible when obstacle regions are present. While there are 
good algorithms for constructing and searching a visibility graph, this is more work than is necessary. To 


initialize path annealing, we conduct a limited search through a special representation of the WRP input map. 


1. Edge Dual-Graph 


A connected graph embeddable in the Cartesian plane without intersecting arcs and whose vertices 
are minimum degree two 1s known as a planar graph. Restricting the arcs of a planar graph to straight lines 
results in a planar straight-line graph (PSLG) [Prep87}. Our WRP input maps are PSLG’s. We further restrict 
these maps to consist of convex regions only. For all such structures, graph theory defines the notion of a dual 
graph. Regions in the planar graph become vertices in its dual graph; whereas vertices in the planar graph 
become regions in its dual graph. In the dual graph arcs connect vertices corresponding to adjacent regions in 
the original graph. Thus, a one-to-one correspondence exists between arcs in the planar graph and arcs in its 
dual. While this kind of dual graph is often a valuable problem transformation (c.g. Min/Max Cut Problem), 
it is not that useful for our purposes. Instead, we construct a dual representation for a WRP map that differs 
from the standard region dual-graph described above. 

We define a dual representation of a WRP map called the edge dual-graph. The discussion which 
follows refers to two distinct representations of a problem instance — the weighted region input map and its 
corresponding edge dual-graph. In order to avoid confusion, we will use the terms vertices, edges, regions, 
and map to describe a weighted region map. We will use the terms nodes, arcs, and graph to describe the edge 


dual-graph. The edge dual-graph is essentially an adjacency list representing the spatial structure of the map 


Sif 


at a relatively high level of abstraction. To create this graph, we assign a node to the midpoint of each map 
edge which does not bound an obstacle (or the border). Special nodes are assigned to the start and goal points. 
In each non-obstacle region, we add arcs to connect all nodes representing the edges which bound the same 
region. The fact that all regions are convex guarantees that all such arcs cannot intersect obstacles or other 
regions. Thus, each region contains a clique consisting of all nodes representing its non-obstacle boundary 
edges. The regions containing the start and goal points will have additional arcs connecting the start or goal 


nodc to the clique. Figure 3.2 illustrates a simple WRP map with its associated edge dual-graph. 


INPUT MAP EDGE DUAL-GRAPH O-—---O 





Figure 3.2 Weighted-Region Problem Map and Edge Dual-Graph 
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2. Search for an Initial Solution 

We obtain the initial solution by conducting an A* search of the edge dual-graph. The cost 
function is the weighted Euclidean distance. The estimated cost to the goal is straight-line distance to the goal 
weighted by the map’s lowest cost coefficient, W. The is an underestimate to the goal, because it is weighted 
by the optimal cost. Therefore, the search is admissible, and returns the shortest weighted midpoint path, and 
the corresponding WS in which it resides. We refer to this path as the optimal midpoint path. Note that we 
should not expect this midpoint path to be globally optimal; nor should we expect that its corresponding WS 
necessarily contains a globally optimal path. However, the optimal midpoint path does represent a reasonably 
good initial solution. 

Simulated annealing does not require the optimal midpoint path from which to begin. We could 
begin with any feasible solution regardless of its cost. So, we could overestimate distance to the goal, thereby 
inducing a greater depth-first component to the search [Pear84]. Such an evaluation function usually finds a 
solution faster. The resulting midpoint path might be of higher cost, but nevertheless, will be feasible since 
the edge dual-graph does not pass through infinite cost regions. However, there are two advantages to 
initializing with admissible A* search. First, the resulting midpoint path is a reasonably good starting 
solution. It is an indication of a high-speed avenue with a higher potcnual for containing (though not 
necessarily) the optimal or a near-optimal path. Much empirical research indicates that simulated annealing 
is faster when provided with reasonably good initial solutions [John89, Naha&86, Bono84]. Second, the total 
cost of this path provides an upper bound on the cost of the globally optimal path. Since we want the least 
upper bound obtainable, then it is desirable to find the best midpoint path. 


D. COST FUNCTION EVALUATION 


In the main phase of annealing, each newly gencrated WS must be evaluated to find the cost of its 
locally optimal path. In many annealing applications the cost of a sample solution is easily evaluated. But in 
path annealing, cost function evaluation is difficult and may require a relatively large amount of computing 
time. Thus, streamlining this procedure is a high priority. 

Recall that the convexity proof implies each WS contains a uniquc shortest path [Rowe90b, Mitc90}. It 
is possible to find this path (within some precision) using Snell’s-Law ray-tracing and a standard iterative 
search technique such as false position [Rich87]. By assuming that each edge in the WS is an infinite length 
line, we can treat a WS similar to Richbourg’s wedge. However, the Ieft and right boundaries defining a 


wedge are Snell’s Law paths themselves. In contrast, the left and right boundarics of a WS are lines through 
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the terminating vertices of the edges which define the sequence. As a result, a WS may have no Snell’s Law 
paths within it at all. We find that locally optimal path for many WS's is constrained by, and therefore passes 
through one or more of the vertices of the defining edges. An itcrative ray-tracing approach to WS 
Optimization can expend much computing time backtracking to false starts caused by the ray failing to 
intersect edges within the WS. In the next section, we describe WS optimization techniques which take more 


advantage of the nature of WS’s. 


1. Single-Path Relaxation (SPR) 

Because Snell’s Law determines the local optimality criteria for path segments that cross 
boundary edges, it is possible to find the shortest path constrained to a WS without itcrau vely computing total 
path-cost. Given an arbitrary WS from start to goal, one can locate the optimal path constrained to the defining 
edges using the coordinate descent method proposed by [Smit88] (also suggested by [Mitc90]). Beginning 
with a path through the midpoints of the edges, consider any set of three consecutive points P re P,. and P,. 
Fix the outside pair, P ; and P ; and use Golden Ratio search [Press88] to adjust ES to the point on the middle 
edge at which the weighted distance of path P pPyP, is minimized. The point P, will be located on the 
middle edge such that Snell's Law ts satisfied relative to P F and P,. Applied to any set of three consecutive 
points along a path through a WS, this procedure cannot increase total path-cost. Because of this, we may 
apply the procedure iteratively from start to goal. Beginning with the first set of three consecutive points 
which includes the start point as P p adjust i to its Optimal location, and slide to the next set of three points. 
This process continues to the goal point, then reverses direction moving back to the start. Passes conunue in 
alternating directions until one complete pass in either direction is made through all points, dunng which no 
point moves from its previous position more than some precision €, referred to as relaxation tolerance. The 
procedure converges on the locally optimal path because total weighted path length is a monotonically 
decreasing funcuion of the sequence of adjustments (Smit88]. It is also possible to pass through the WS 
continuously in the same direction (such as start to goal). However, we have found that moving in alternaung 
direcuions tends to Cause faster convergence. 

Simulated annealing cannot afford expensive primitive operations. Smith's coordinate descent 
method avoids the direct use of Snell’s Law and expensive tigonomeuic functions, which is good. Also, the 
technique makes good use of the bounding vertices of the edges. However, simple testung of coordinate 
descent using Golden Ratio search suggests that Smith’s method, though accurate, is too slow to be of 


pracucal value in path annealing, since long WS’s can require a very large number of iterations. Furthermore, 
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wide window sequences with long edges can have very slow convergence to the locally optimal path. 
Therefore, we investigated faster alternatives. 

Direct determination of a starting direction for a ray-trace which must cross several boundary 
edges to hit a known target point is very difficult. Combining the system of equations representing the Snell’s 
Law criterion at each boundary crossing, results in a very high-degree-polynomial equation, whose solution 
yields the starting and target-point coordinates [Mitc90]. However, if only a single boundary edge separates 
the starting point and the target, then we only need to determine the point of optimal crossing on the boundary 
edge between start and target. Snell’s Law has no closed form to compute this point directly. This 1s one 
reason that (Smit88] resorts to Golden Ratio search. Nonetheless, if the range of region cost coefficient values 
is known, then we can directly determine optimal crossing points with a very fast table-lookup procedure. We 
employ this procedure in the coordinate descent technique described ecarlicr by replacing Golden Ratio search 
with a constant-time Snell’s-Law-table lookup. We refer to our method of coordinate descent using table- 
lookup as single-path relaxation (SPR). 

The problem of finding a Snell’s Law crossing point on a boundary edge between two fixed points 
requires a three-dimensional table. Recall from Chapter I that by rescaling rational cost coefficients {Mitc90], 
itis always possible to establish integer cost coefficients fora WRP. To construct an appropriate Snell’s-Law 
lookup table, it is necessary to determine the expected working range of cost coefficient ratios a priori. By 
working range, we mean those encountered most often in maps of interest. Our implemented table uses 
integer ratios. It is not necessary for the set to include every ratio to be encountered; out-of-bounds conditions 
can always trigger a more expensive Golden Ratio search. However, our objective is to severely reduce the 
number of mes a lookup must resort to iterative search. 

Given fixed approach points P ; and Po. we normalize the geometry of a typical crossing episode 
on a standard rectangle as shown in Figure 3.3. Note that we orient this rectangle such that the crossing edge 


is always parallel to the x axis. Four parameters characterize every crossing episode geometrically similar to 


this rectangle: 
p= LJ F (ratio of cost coefficients) (Eg 3.1) 
P=x /y, (inverse of the slope of line P fie) (Eq 3.2) 
i Y/Y, (ratio of y coordinates of P, and eS) (Eq 3.3) 
i xy, (ratio of x coordinate of P ploy coordinate of P,) (Eq 3.4) 
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boundary 
edge Ey 





Figure 3.3. Crossing Episode Geometry 


The mathematical basis of the table is derived as follows. For optimal crossing point ie Figure 3.3 obeys 


Snell’s Law: 

Sin(@,) / Sin(8,) = H / 1, =P (Eq 3.5) 
Letting p = L/L ; and applying tngonometric identities we derive the equivalent expression: 

D= Cos(ArcTan(y,/x,)) / Cos(ArcTan((y Yo xx) (Eq 3.6) 


Muluplying each arctangent argument by (1 ly MAb) and substituting yields a parametric equation in four 
variables, where p, r, and y’ determine x: 

p = Cos(ArcTan(y‘/x’)) / Cos(ArcTan((1-y’)(r-x))) (Eq 3.7) 
where x’ = xy, p= > OS x/y 5 and y’= ee 
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For any given crossing episode, the values of p, r, and y’ are known. Golden Ratio search precomputes the 
table values of x’ which satisfy Eq 3.7 for discrete values of the other parameters. Figure 3.4 tabulates the 


parameter ranges and key characteristics of our prototype Snell’s-Law lookup table. 


Range 
Low High Increment No. of Values 
p 1.00 10.00 + 45 
r 0.00 10.00 0.05 201 
y 0.00 1.00 0.05 744 | 


* based on cost coefficient ratios 1/14 =p 
where yp; € {1,2,3,...,10} and py < pL» 


Total no. of function points = 45 * 201 * 21 = 189945 


Total raw space required on disk = 760180 bytes 


Figure 3.4 Characteristics of Snell’s-Law Lookup Table 


Recall that all region weights, H., are drawn from the integer set {1,2,..,10,00}. We use this set to 
indirectly index the proper value of p in the lookup table. Note that it is always possible to orient the geometry 
of an episode such that p < 1 is true. Therefore, we employ a two-dimensional triangular array of 45 entries, 
indexed by integer tt values in numerator-denominator pairs. The array holds the indices to the exact values 
of x’ in the lookup table. 

Consider the generalized crossing episode in Figure 3.3. From fixed points P , and P, we can 
easily determine intersections / 9° if p and J,, and associated distances relative to the edge, E 0° With this data 
the lookup procedure computes the parameters r and y’. The parameter, p, is exact and indexes the appropriate 
plane in the table. Using r and y’, the indices are created to bracket the appropriate value for x’ within a two- 
dimensional rectangle. Simple linear interpolation determines a value for x’. This value gives the location of 
the optimal crossing site on E, relative to both yp and its left vertex. Since x’ = xy, then the location of the 


optimal point relative to x, is x, = Oe y- 
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The location of the optimal crossing point on E g assumes an infinitely extended boundary edge. 
However, all boundary edges are actually finite length segments. Therefore, the optimal crossing point may 
not always lie between the vertices which define the boundary edge. In such cases, the optimal crossing point 
will be the closest vertex. We refer to these occurrences as constrained crossings, because the optimal 
crossing must violate Snell’s Law (as little as possible) to satisfy restrictions of boundary edge length. A 


constrained crossing is illustrated in Figure 3.5. 





P2 


constraining vertices 
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Figure 3.5 Constrained Optimal Crossing 


By always orienting the crossing edge E 9° fixed points P : and Fs and cost coefficients | and LL, 
as shown in Figure 3.3, we can detect many constrained crossings before applying the complete table-lookup 
procedure. Note that in Figure 3.3 an unconstrained optimal crossing can only occur between intersection 
points / g and I). If both vertices of the crossing edge lie outside of the interval defined by / 3 and l, then a 
constrained crossing is certain, and table-lookup is unnecessary. The vertex closest to the / ae ; interval is the 
optimal crossing site. Otherwise, if a table-lookup is still necessary, the location of the optimal crossing point 
returned by the lookup is compared to the location of edge vertices to determine if a constrained crossing is 
optumal. 

In summary, the work to lookup x’ requires three intersections, three distance calculations (to 
determine Xp Vp)» and one linear interpolation in two dimensions. Thus, a single lookup can be done in 
constant time. On rare occasions, if the geometry of a crossing episode causes the parameters to fall outside 
the bounds of the table, then the lookup procedure defaults to Golden Ratio search. The major steps of the 


optimal-crossing-point lookup algorithm are outlined in Figure 3.6. 


Input: 
fixed points P,, Po 
crossing edge Ep, (defined by vertices V,, V>) 
cost coefficients j1,, U2 where u; < po 
Output: 
snell’s Law crossing point Po 


Optimal Crossing Point Algorithm: 


Assume that E, extends infinitely in both directions and compute 
Straight-line intersection lp of Ep and line P;Po. 


IF Eg is a phantom edge 

THEN Ip is Pg, check for constraining vertices and return 
ELSE compute perpendicular intersection I, from P» on Eg 
IF Vo is between I» and V; 

THEN V2 is Po. 
ELSE IF V, is between V2 and Ip 

THEN V; is Po, return V,; as Po 


ELSE compute perpendicular intersection I1 from P1 to Ep 


CALL C routine snell(P;,Po,l4,Ip,lo,2,4). Snell uses 1,,l5 to 
determine if table lookup can compute Pp. If not, then Ip,l5 are 
used as Starting points for Golden Ratio search to find Po. 


Check for constrained Snell’s-Law vertex crossing and return. 





Figure 3.6 Optimal-Crossing-Point Table-Lookup Algorithm 


To compare the table lookup procedure to pure Golden Ratio search, we generated random 


crossing episodes across a single boundary edge of 100 map units in length. For each episode one random 
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point was selected from each square region on either side of the crossing edge. For the two regions, unequal 
pairs of weights, 1, and .,, were randomly assigned from the set {1,2,...,10}. Timing results of the tests 
indicate that the table lookup is one order of magnitude (10 times) faster than pure Golden Ratio search. These 
results include time needed by the table lookup procedure to perform an occasional Golden Ratio search when 
random out-of-bounds conditions occur. To compute the accuracy of the lookup routine, we assume that 
Golden Ratio search finds the exact optimal point and, consequently, the true minimum weighted distance. 
Let C Gp be the total weighted cost of a crossing episode as computed by Golden Ratio search. Let the 
corresponding table-lookup value be Ca We compute relative error in weighted distance as 
[omen ee WAG... (Eq 3.8) 

For 100,000 random samples the mean relative error was 3.83107 with standard deviation 1.73x10°, The 
maximum relative error is on the order of lone and occurs in less than 0.01% of the sample. We should 
expect some error, since our two-dimensional linear interpolation 1s an approximation of a curved surface by 
a flat plane. Figure 3.7 is a plot of the discrete points in the table for p = 1.1. Although slight, the curvature 
of this surface is most noticeable at the lower values of r and y’. The squaring and square root operations of 
weighted distance soften the effect of interpolation error on x’. Nonetheless, we can rely on about 5 decimal 
digits of accuracy for the opumal weighted distance of a crossing episode. Note that there are only 6 decimal 
digits of precision provided by our implementation language, Quintus Prolog [Quin90]. Depending upon the 
length of a WS (.e. how many crossing episodes), errors can accumulate. However, because mean relative 
error is essentially zero, we may assume that errors accumulated over long WS’s will usually cancel one 
another. We conclude that the Snell’s-Law-table lookup method provides SPR with a reasonably accurate 


and efficient means for computing optimal crossing points on boundary edges. 
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3.7. Surface Plot of Snell’s-Law Table (x’ 
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Uniform-Discrete-Point (UDP) Approximation 
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While local path optimization with SPR is fast, the procedure can sometimes run into worst case 


Situations. In practice we have found that even with a relatively slack relaxation tolerance, SPR may 


sometimes converge at an unacceptably slow rate. This happens if the midpoint path (starting condition) is 


far from optimal and has few sharp bends. In such situations the improvement of each crossing-point 


adjustment may be slight. Therefore, a large number of iterations may be necessary to optimize the path. 


Figure 3.8 illustrates a typical worst case for SPR. In this example the rate of SPR convergence decreases 


rapidly as the solution approaches optimum. 
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Figure 3.8 Worst Case Convergence for Single-Path Relaxation (SPR) 
(dark path marks progress from midpoints after four passes) 


Usually at high annealing temperatures a large number of the WS’s sampled will have locally 
opumal path-costs which are very large. Therefore, accurate WS cost evaluation is only necessary when the 
locally optimal path might be globally optimal. Both theoretical and empirical evidence validate the use of 
approximations to the actual cost function [Adam85, Tove88]. To capitalize on this idea, we implement a very 
simple approximation to pre-evaluate the cost function of a WS. We refer to the method as uniform-discrete- 
point (UDP) search. It is essentially Dijkstra’s algorithm restricted to a WS. UDP is used to rapidly 
approximate the locally optimal path through a WS, and, if necessary, to provide a starting path for SPR. 
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Uniformly spaced points, called edge-points, are specified on each edge in the WS. From the start point, all 
paths constrained to pass through this set of points are searched. The discrete interval, 5, defines the upper 
bound for the separation distance of any pair of adjacent edge-points. Given a value for 6, all edge-points can 
be predetermined and stored for all boundary edges. For a given edge of length, /, the number of required 
edge-points is 

m=[(/5) +1 1. (Eq 3.9) 

The m points (which include terminating vertices) are then evenly spaced across the edge. For any edge with 
non-zero length, there must be a minimum of two edge-points — the terminating vertices. Note that the 
resulting structure can be viewed as a higher resolution edge dual-graph. 

This idea is similar to one used by [Papa85) to efficiently approximate the optimal path through a 
field of polyhedral obstacles. To each obstacle edge, he assigns discrete points spaced exponentially out in 
either direction from the closest point on the edge (the perpendicular intersection from a previous fixed 
reference point). Exponential spacing is essentially a device which holds the subsequent path search to 
polynomial ume. However, the polyhedrons in this three-dimensional obstacle-avoidance problem are all 
obstacles (i.e. travel is not permitted within them). Therefore, optimal paths tend to avoid their vertices, and 
settle into closest approach tangents across polyhedron edges. So, in a sense, exponential spacing also 
represents point samples from a normal probability distribution centered at locations mosi likely to be on the 
optimal path. In the WRP this notion is countered by the added dependence of optimal paths upon relative 
region weights as well as direction. The relative positions and weights of regions can often override the 
natural tendency for very straight optimal paths. Therefore, it appears that uniform point-spacing is more 
appropriate for the WRP. 

To approximate the optimal cost of a window sequence (WS), the uniform-discrete-point (UDP) 
procedure works as follows. Beginning from the start point (or inversely the goal), Dijkstra’s Algorithm 
proceeds through the WS toward the goal. Back pointers are recorded at each point on an edge to indicate the 
direction of the shortest path back to the start. When the goal point is reached, the shortest path is retrieved 
through back pointers. This search is fast because it 1s restricted to a WS. Consequently, the search always 
proceeds in order of WS edges from the start point. The time complexity of the algorithm is O(nm’), where 
nis the maximum number of edges in any WS and mis the maximum number of edge-points assigned to any 


edge in the map. Note that m is a function of 6 and the longest edge in the map. 
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3. Combining Techniques 

In our implementation, to find the locally optimal path in a WS, we employ uniform-discrete-point 
(UDP) approximation and single-path relaxation (SPR) in a two-stage combination. For a given WS, the UDP 
solution path is a more refined estimate of the local optimum than the midpoint path. Thus, UDP can hasten 
SPR convergence by finding a starting path which is usually closer to the true local optimum than the 
midpoint path. In stage one, UDP rapidly selects the locally shortest path constrained to discrete 6-spaced 
edge-points in the WS. In stage two, SPR begins from the path returned by UDP through these edge-points. 
Only a few passes by SPR will suffice for convergence to the true local optimum. 

Both UDP search and SPR can be tuned to a desired accuracy by adjusting the discrete interval, 
5, and the relaxation tolerance, € (see Section III.D.1), respectively. We have found that setting 5 equal to the 
average length over all edges tends to balance the assignment of edge-points uniformly across the map. We 
assume that the length of the shortest edge is closely related to the intended map resolution and required 
solution accuracy. Using mean edge-length to set 5 strikes a compromise between accuracy and speed over 
all problem instances associated with a given map. The value of 5 might also be computed dynamically based 
upon the lengths of boundary edges between and in the vicinity of start and goal locations. As we will discuss 
in Chapter IV, our particular choice of 5 provides another opportunity to improve performance through 


heuristics. 


4. Reentrant Window Sequences 


A window sequence (WS) which contains at least one reentrant path is called a reentrant window 
sequence. Recall from Chapter II that a reentrant path exits a high-cost region by striking a boundary edge at 
the Snell’s-Law cnitical angle, travels along the edge incurring the cost of the low-cost region, and reenters 
the high-cost region at the critical angle (see Figure 2.3). Reentrant WS’s present no special problem for UDP 
approximation, since this method is not Snell’s-Law based. However, we note that such WS’s are distinctly 
different from those which cannot contain reentrant paths. A WS which contains reentrant paths should list 
each reflective edge twice in succession to indicate that there are two distinct tuming points on it — the point 
of exit from and the point of reentry into the highest region it bounds. UDP approximation simply assumes 
that for each edge identifier in the WS there must be a corresponding optimal path turning point. Given a WS 
and its edge-points, the algorithm determines an optimal edge-point on each edge by running Dijkstra’s 
algorithm. For each edge listed twice in succession, weighted distances between all pairings of its edge-points 


are computed using the optimal weight of this edge. The pair returned as optimal on this edge is the pair along 
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the shortest weighted back-pointer path retrieved after the goal point is reached. If a reentrant path is, indeed, 
locally optimal within the WS, then the pair returned with the optimal list will usually be those edge-points 
which least violate Snell’s Law. However, in some cases a reentrant path cannot be locally optimal for the 
WS (i.e. when it is always cheaper for a path to travel directly through the region instead of reflecting). This 
happens most often when a reentrant WS is forced onto a boundary edge from its low-cost side. Figure 3.9 
illustrates such a situation. A reentrant path against edge E between approach points p F and P, is not an 
advantage over the direct path p , © Pp: In this case the pair of entry/exit points returned corresponds to a 
single point. The resulting path segments can always be shortcut at less cost. However, we expect this because 
a reentrant WS intentionally forces the cost evaluation mechanism to find the best path which hits the 


reentrant edge whether or not this path represents cost improvement over the original direct route. 


high-cost region 





Figure 3.9 Uniform-Discrete-Point (UDP) Approximation Is Forced to Reenter a 
Low-Cost Region from the Low-Cost Side of a Boundary Edge 
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Unlike UDP, SPR must recognize each reentrant path location within the WS because it must 
adjust entry and exit points to the Snell’s-Law critical angle, instead of executing a table lookup. This angle 
is measured from the approach points, i.e. the edge-crossing episodes just prior to and after the reflective 
edge. When a reentrant path is encountered during a single-path relaxation pass, critical-angle reflection 
points are determined using Snell’s Law from the most current approach points. The stopping condition for 
SPR, i.e. one complete pass through the WS without any point adjustment greater than tolerance €, never 
depends on reflection point adjustments, only on crossing point adjustments. This is because reflection points 
are predetermined by the adjustments of their corresponding approach points. Therefore, it is sufficient to 
monitor only the adjustments of crossing points (i.e. non-reflection points) in order to detect convergence to 
the locally optimal path. 

Recall from Chapter I that phantom edges are edges which which bound regions with equal cost 
coefficients. They are used to ensure that all regions are convex. When a reentrant path is forced against either 
a phantom edge or a higher-cost edge, it is known a priori that the reentering path cannot be locally optimal. 
In such cases, SPR ignores the reentrant path route and optimizes the straight-line path between crossing 
episodes immediately before and after the points of reflection (i.e. approach points), effectively bypassing the 
reflective edge. This situation is illustrated in Figure 3.10. The WS still lists the reflective edge twice. The 
reason for this is that there may still exist an edge within the adjacent region bounded by the reflective edge 


on which reflection may still be advantageous. This will be discussed more in the next section. 
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Figure 3.10 Single-Path Relaxation (SPR) Ignores Non-Advantageous Reentrant 
Path When Forced to Reenter a Low-Cost Region 


E. MOVE OPERATIONS 


Simulated annealing samples many different solutions by randomly applying move operators to explore 
the solution space. In path annealing, the move generator works in the space of WS’s. Recall that we represent 
each WS uniquely as an ordered list of edge identifiers. A new WS can be created from another by little more 
than random number generation, data retrieval, and list processing. The move generator perturbs the current 
WS by rerouting it through neighboring edges and regions. Repetition of this process enables random search. 
Annealing does not normally search the entire solution space. Nevertheless, all feasible solutions should have 
some chance of being sampled. Our prototype employs two very simple move operators. These operators 
require data structure support in addition to the edge dual-graph (previously discussed). In this section, we 


introduce these move operators and discuss their sampling capabilities. 
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1. Vertex Rotation 

Consider an arbitrary window sequence, WS r between designated start and goal. One of the 
simplest ways to obtain a new window sequence, WS.,, is to shift WS ) actoss a vertex which defines one of 
its edges. We call this operation vertex rotation. The operation is relatively efficient because vertex edge-lists 
(see Section III.B.2) are readily available in sorted order. 

Given WS ,, path annealing generates a neighboring WS , as follows. Generate a random integer to 
select one vertex of one edge in WS r This vertex, called the rotation vertex, defines the site of intended 
displacement. If the rotation vertex is a border vertex then backtrack and randomly select another vertex. Let 
E be the vertex edge-list for the rotation vertex. Let E’ be those edges in E which are also members of WS r 
Then, WS 5 is defined by the set operations 

WS, = (WS, -E) U(E-E)=(WS,- EQ UE’ (Eq 3.10) 

Eq 3.10 simply implies that we replace the edges in E currently in WS ; with the edges in E which are not in 
WS r The result 1s WS,. Of course, order in each set is significant, and list reversals must be performed as 
necessary. 

The vertex rotation operator has an important side-effect. Given the rotation vertex Vp» the current 
WS is scanned for the first and last occurrences of edges in the vertex edge-list of Ve All edges between these 
two edges in. !usive will be removed. Thus, if random perturbations have formed a WS with an open loop 
which crosses two edges incident to Vp» then a rotation across Ur will cause the WS to cross itself at the open 
base of this loop, and the set operations of Eq 3.10 will remove it. By the Optimality Principle, a globally 
optimal path cannot cross itself. It follows that any WS which crosses itself cannot contain the optimal path. 
Therefore, a significant advantage of vertex rotation is its automatic removal of WS’s which contain cyclic 


paths. 


2. Obstacle Jumping 
The presence of obstacles necessitates special consideration. Recall that the edge dual-graph 
which represents the feasible solution space does not contain arcs through obstacle regions. However, we can 
view obstacles as eniarged vertices with non-zero area. Thus, to enable obstacle rotation or obstacle jumping, 
we employ a special data structure similar to a vertex edge-list. An obstacle edge-list (see Section III.B.2) 
records the clockwise ordered list of incident edges around an obstacle. If an obstacle vertex is selected as the 
displacement site, the WS shifts completely across the obstacle by using the operation of Eq 3.6, where E is 


now the appropriate obstacle edge-list. 
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It is also possible to jump some obstacles by a sequence of normal interior vertex rotations. A jump 
of this type occurs as the result of pinching a looping path which has circled the obstacle from both the 
clockwise and counterclockwise directions. Figure 3.11 illustrates a path within a WS with the potential for 
jumping obstacle region A. Closing the base of the loop by rotating across vertex ue will remove the detour 
around obstacle region A, replacing it with the dotted path segment and its associated WS. Not all obstacles 
can be jumped in this manner. For such a jump to occur enough interior vertices and edges must surround the 
obstacle so that a WS can be perturbed completely around it in either direction. Obviously, obstacles which 
connect directly to the map border cannot be jumped this way (e.g. the obstacle region B in Figure 3.11). For 


such cases, explicit obstacle rotation is necessary. 





Figure 3.11. A Path with the Potential to Jump Obstacle A on a Single Vertex 
Rotation at V, 
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While obstacles and interior vertices are logically equivalent with respect to the rotation operator, 
we ensure that they are distinguishable. In particular problem instances it may be more efficient to reduce or 
temporarily prevent the capability to jump obstacles. This control 1s necessary because the move generator 
can have a natural bias toward selection and jumping of large obstacles with many vertices. This 1s especially 
true when the current WS includes several edges incident to the same obstacle, as is often the case 
immediately after jumping it. In such situations, given an equal probability of selecting any edge in the WS 
from which to obtain the rotation vertex, that vertex with the most incident edges in the WS will have the 
greatest likelihood of being selected. This bias can waste valuable sampling time with useless repetition as 
the move generator attempts to jump back and forth across a single large obstacle. As well, there are good 
reasons for ignoring this bias and allowing the annealing process to make its own decisions. We defer a more 


complete discussion of these reasons and methods of obstacle control to Chapter IV. 


3. Reachability 

Recall that the move operators should guarantee reachability; that is, that all feasible solutions 
which could be optimal are accessible to the annealing process with a non-zero probability. This is to ensure 
that optimal solution cannot be overlooked intentionally. Do not confuse this term with completeness, which 
describes a sccmingly similar guarantee offered by systematic search algorithms. The difference is in the 
probability cf locating a globally optimal solution. An algorithm which offers completeness will find the 
opumal solution with probability one; the probability of not finding it is zero. However, reachability means 
that both the probability of finding the optimal solution as well as not finding it are non-zero. 

A move generator based only upon the rotation operators (vertex and obstacle) can only guarantee 
reachability for a subset of those WS’s with the potential to contain a globally opumal path. We refer to this 
subset as the class of proper window sequences. The class of proper window scquences is all WS’s which do 
not enter the same cost region more than once. This definition implies that no proper WS can cross any 
boundary edge more than once, otherwise it necessarily reenters some region. In contrast, an improper 
window sequence may enter the same cost region multiple times. We have proven in Theorem 3.3 (see 
Appendix A) that all proper WS’s are reachable from any initial proper WS in a convex weighted region map. 
Thus, if only proper WS’s could contain globally optimal paths then our move generator would guarantee 
reachability. Unfortunately, in some problem instances an improper WS may contain the opumal path. The 


next section discusses these improper WS’s and the additional move operator required to reach them. 
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4. Reentrant Installation 

Although an optimal path cannot cross, it can cross the same edge more than once, and therefore, 
can also reenter a region. Recall from Chapter II that an optimal reentrant path will obey Snell’s Law by 
striking a boundary edge at its critical angle and traveling along the edge just inside the lower cost region. 
Since we disallow linear regions (e.g. roads), such a path may exit the edge in only one of two ways. It may 
travel to a terminating vertex (Figure 3.12), where Snell’s Law does not apply. Or, it may reenter the region 
at the Snell’s-Law critical angle (Figure 3.13). In either case, the path can still be globally optimal. The former 
case involving the terminating vertex is contained within a proper WS. Since this path does not reenter the 
region, then it must cross a different edge when it reaches the vertex. Such paths are contained within proper 
WS’s which can be reached by the rotation operators (Theorem 3.3 in Appendix A). However, the reentrant 
path in the latter case must reside within an improper WS. The reason is that the path reenters a region, and 
thus, by definition (see Section 3 above) can only be within an improper WS. The rotation operator alone 
cannot reach improper WS’s. 

A simple argument shows why this is true. Suppose that some arbitrary sequence of rotations 
applied to a proper WS results in an improper WS. Without loss of generality, we may assume that at some 
point in the sequence a rotation operation transformed proper window sequence WS ; into improper window 
sequence WS > This would require that the rotation insert at least one edge idenufier into WS , more than once 
to create WS,. But this contradicts the definition of a rotation since the only edges inserted are those which 
are not already in the window sequence. Therefore, our assumpuon that a proper WS was transformed into 
an improper WS is false. It follows that a rotation can never create an improper WS from a proper WS. Asa 
consequence, the rotation operator alone can never create a WS with a reentrant path. We need an additional 


operator to reach improper reentrant WS’s. 
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Figure 3.12 Critical-Angle Reflection Path (non-reentrant) 
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Figure 3.13 Critical-Angle Reentrant Path 
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The reentrant installation operator perturbs a window sequence (WS) by forcing it to reflect on 
one edge. This so-called reflective edge is selected randomly. The selection process is similar to that for a 
rotation vertex. The reflective edge is randomly chosen from the set of all crossable edges that bound regions 
through which the current WS passes. Edges which have crossing episodes within the current WS cannot be 
reflective edges. Transformation to the new WS isa simple double insertion of the reflective edge identifier. 
In Figure 3.14, window sequence {s,1,2,3,g} becomes {s,1,4,4,2,3,g} after reentrant installation on reflective 
edge 4. Note that the new WS is improper because by crossing edge 4 twice to reflect, the WS enters the same 
cost region twice. However, the evaluation of WS {s,1,4,4,2,3,g} will discover if a reentrant path exists which 


improves cost by using two points on edge 4. 


{S,1,2,3,G} > {$,1,4,4,2,3,G} 





Figure 3.14 Installation of a Reentrant Window Sequence 


It is not possible for an optimal path to reenter the same region on both of two adjacent boundary 
edges. Instead, the path must detour around the common vertex or cut straight across the region between the 
approach points. This fact is based upon a proof given in [Mitc90] which concludes that between any cnitical 
point of entry (exit) and the next critical point of exit (entry) the path must pass through at least one vertex. 
Because of this, our path annealing prototype will not create WS’s with reentrant paths on two consecutive 


boundary edges. 
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It is possible for opumal paths to cross a sequence of several boundary edges, reflect and reenter 
a region at the last edge, and double back through the same sequence of edges in reverse order. Figure 3.15 
illustrates the case of an optimal path which must cross several edges to reflect on the last and return. To reach 
the improper WS containing this path, four reentrant installations must be stacked by effectively pushing each 
through the one preceding it. To reach such special cases requires that the move generator install reentrant 
paths against an edge on which a reentrant already resides. Therefore, we allow reentrant installations to push 


(i.e. stack) through one another, ensuring that such special situations are reachable. 


\/ 


Figure 3.15 Reentrant Path Crosses Edges Multiple Times 


Recall that reentrant-path optimal solutions tend to be rare because they require particular cost- 
region placements and angular alignments [Rich87, Mitc90]. Regardless of this, we give the reentrant 
installation and rotation operators equal probability of selection, and let the annealing process accept or reject 
their resulting transitions stochastically. This means that reentrant edges will be frequently installed into the 
current WS. A newly installed reentrant edge which greatly improves local optimal path cost of the current 
WS is more likely to be kept within the current WS. This reduces the chance of eliminating good reentrant 


paths by the vertex rotation. 


5. Improving Reachability 

The rotation and reentrant operators are capable of reaching all proper WS’s and improper WS’s 
which contain at most one reentrant path per edge. However, acyclic improper window sequences (WS) exist 
that these operators cannot reach. Unfortunately, some of these can contain an optimal path. We can trace the 
problem to an interaction between the rotation and reentrant operators. Consider the special case of an optimal 
path in Figure 3.16. Note that the very long edge bounding the top of the narrow cost-region is crossed several 
times by the optimal path. The vertex rotation operator Cannot create such a WS because it automatically 
removes edges which are already in the WS. The reentrant operator only stacks reentrants on the same edge 
it cannot install them side-by-side. No combination of these operators can generate this WS from an arbitrary 
proper WS. Therefore, the rotation and reentrant operators cannot ensure complete reachability for all 


possible globally optimal paths. 


SE 


Figure 3.16 Optimal Path Crosses Edge Ep Multiple Times (integers are cost 
coefficients) 


In the case of Figure 3.16, it is possible to modify the reentrant operator so that reentrants can be 
installed side-by-side on particularly long edges. This would require that the algorithm recognize boundary 
edges whose length and geometry could allow multiple reentrant optimal paths. Then, when such an edge 
were selected for reentrant installation, if a reentrant path already existed on this edge, then an additional 


decision (possibly random) would have to made to stack the reentrant or install it side-by-side. 
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One way to avoid operator modification is to fix the source of the problem — relative edge-length. 
When a long boundary edge is situated among relatively short edges there is an increased likelihood that an 
optimal path may cross this edge multiple times. It is tempting to believe that complete triangulation of all 
regions will preclude any optimal path from crossing a single edge more than twice. Unfortunately, this is not 
true. Consider Figure 3.17 in which two near-degenerate triangular regions are adjacent with cost coefficients 
as shown. The path from S to G crosses the long edge (center) three times. Note that by squeezing these 
triangles closer to degeneracy, we can eventually reach a geometry which ensures that the path shown is 


optimal for S to G. 





Figure 3.17 Optimal Path Crosses Edge Eg Multiple Times (triangular regions) 
(integers are cost coefficients) 


From the above simple example we see that the problem concerns resolution disparity in the map. 
The dimensions that are generally parallel and transverse to the long edge have a relatively large resolution 
differential. The disproportionately long edge allows ample opportunity for short transverse crossings to 
greatly improve path efficiency in parallel directions. In Figure 3.17, two path segments that are generally 
parallel to the long edge become more efficient by connecting them with a very short, and therefore, relatively 
low-cost transverse segment. We can easily prevent this problem with the addition of one vertex at the center 
of the long edge and two phantom edges connecting it to existing vertices in either region. This does not 


change the representation of the map. It simply balances the resolution of the map in a localized area. 
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Some simple preliminary map analysis can reduce the risk of having optimal paths with muluple 
edge crossings by identifying and partitioning particularly long edges. This can be done by examining the 
length of each edge, e, relative to its immediate environment. Let B represent the set of edges bounding the 
two regions separated by e but not including e. Let V represent the set of vertices on the two regions. If the 
length of e is much greater than the average length taken over all edges in set B, and if the maximum distance 
over all perpendiculars from points in V to e is much less than the length of e, then e should be partitioned 
with one or more additional vertices connected to existing vertices by phantom edges. Figure 3.18 illustrates 
how the long edge in Figure 3.17 should be partitioned. A comparison of cost-coefficients should also be 
made to ensure that the weights of the two regions separated by the edge are large relative to surrounding 
coefficients. If such is not the case then the possibility of a multiple crossing on the edge is minimal even if 


it is long. 





Figure 3.18 Introduction of Additional Edges (dotted) and Vertex (small circle) to 
Prevent Optimal-Path Multiple Crossings on a Long Edge 


We emphasize that the above procedure is heuristic at best. However, a completely thorough 
analysis is likely to be tantamount to solving many weighted-region problems. Furthermore, the rarity of 
reentrant-path optimal solutions and solutions which are not contained within proper window sequences (WS) 
indicates that more detailed analysis is probably not worthwhile. We desire that map resolution be reasonably 


balanced. In the limiting case, as more vertices and phantom edges are added, the map will approach a 
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uniform grid representation, and the advantages of path annealing may diminish. Therefore, a long edge 


should be partitioned only in the case that the conditions indicated earlier are extreme. 


6. Summary of Move Generator 
We summarize the key features of the move generator as follows. Its mechanics are simple and 
involve only two operators — vertex/obstacle rotations and reentrant installations. It guarantees reachability 
for all proper window sequences (WS). The perturbations are small and induce a neighborhood structure on 
the search space. The cumulative effects of the operators are large, particularly at high control temperatures. 


In the next section we discuss the establishment of the annealing schedule and the control of the temperature. 


F. ANNEALING SCHEDULE AND CONTROL 

Although many applications of simulated annealing require large amounts of computing time to arrive 
at reasonably optimal solutions, we have found that path annealing performs reasonably well without the need 
for such. Our annealing schedule is admittedly crude and uses only the simpler ideas proposed by other 
researchers. Path annealing efficiency seems to rely more on good WRP bounds and heuristics (to be 
discussed in Chapter IV) than on a well-tuned annealing schedule. Therefore, we employ the annealing 
algorithm for its probabilistic control of local search through a subset of the solution space. 

While annealing schedules may differ somewhat with particular applications, we use the five control 
parameters descnbed in Figure 3.19. The following sections discuss the establishment of the particular value 


for each parameter. 


Starting temperature in weighted distance map units 


freezing temperature in weighted distance map units 


temperature reduction (cooling) factor; typically 0.70 < R <0.99 
where Tie =R * Tj 


annealing chain length; maximum no. of attempted transitions 
per temperature T, 


maximum no. of accepted transitions per temperature T,; also 
known as a cutoff [Jonn89] 





Figure 3.19 Standard Annealing Schedule Parameters 


1. Starting Temperature 

Recall that annealing temperature, 7, controls the shape of the exponential probability distribution 
used to accept or reject new solution samples. While all cost-decreasing changes are accepted, changes which 
increase the cost are accepted with probability 

P(acceptance) = Exp(-AC/T) (Eq 3.11) 
where AC is the difference between the costs of the new and current solutions (also see Figure 2.6). The 
acceptance ratio over a sample of transitions is estimated by [Aart89] as 

% = (mn, + (m, Exp(-AC*/T) ) / (m,+m,) (Eq 3.12) 
where m_, is the number of cost-decreasing transitions, m, is the number of cost-increasing transitions, and 


| 2 
AC" is the mean over the m, cost-increasing transitions. To ensure that annealing can sample across the 


2 
solution space without trapping between high-cost peaks and freezing too early, it is desirable to set T to 
produce an acceptance ratio close to one. Ratios of .90 to .95 are generally considered close enough 
[Aart89]. 

To determine a good starting temperature, T, (initial value of 7), we have tried an empirical 
technique suggested by [Aart89]. Randomly generate sample transitions in the solution space without 
rejections. From the sample values of AC compute AC*. Eq 3.12 then determines the value of T which 
produces the required y. [Aart89] suggests an iterative approach reported to converge rapidly on a value of T. 

The conclusions of (John90] suggest that simple application-specific formulas can usually be 
derived on the basis of desired acceptance rate and a few problem-specific parameters. Thus, another way to 
determine a starting temperature value is to consider the worst-case transition that can be made by the move 
generator in the map. For very complex problems, such an approach is not always be reasonably possible. 
Fortunately, our representation of the WRP by window sequences allows efficient analysis of individual 
transitions. We desire the value of 7 which makes the acceptance rate as close to one (1) as possible. In Eq 
3.12, let x = 0.95, and replace AC* with an estimate of the greatest cost-increasing value, Max(AC’). 

To determine the value of 7 for an acceptance rate close to one, assume that the generator applies 
only a single operator to the current WS, then retums a new WS for cost evaluation. Since cost-increasing 
reentrant installations usually do not result in large cost changes and because they are not necessary to move 
freely around the solution space, we will consider only rotations. We wish to determine the largest possible 
cost-increasing transition. This transition will likely be the site of a long edge bounding two regions with a 


large cost-coefficient differential. 
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Intuitively, Max(AC*) should depend on an edge with a large weight differential. However, 
dependence upon the length of that edge may not be as clear. The reason that length is a factor is that a rotation 
is followed by local optimization to find cost (UDP approximation). If this rotation has just forced the current 
WS across the large weight differential, then local optmization will also force the locally optimal path to use 
as little of the high cost region as possible. Following this, a second transition across the other vertex of the 
same edge gives optimization no choice but to cross through the high-cost region. While it is possible that 
local optimization can still dampen the cost difference of the second transition, we assume the worst case. 
Ignoring smaller surrounding effects, the largest change will generally occur along the entire length of the 
edge. The situation is depicted in Figure 3.20. 


locally optimal path = 
for WS {S,a,d,G} a “ 


b a locally optimal path 
for WS {S,a,b,c,G} 





Figure 3.20 Maximum Cost Difference Max(AC*) Occurs for WS Transition 
{S,a,b,c,G} — {S,a,d,G} (cost coefficients are boxed integers) 


Thus, to estimate Max(AC*), we have only to analyze the length and weighted-region-cost 


differential for every edge in the map according to the following equation: 


Max(AC™) = Max) ay edges ee — M,)) (Eq 3.13) 
If we assume that in a random sample of transitions m p= My then Eq 3.12 becomes 

X = 1/2 (1+ Exp(—Max(AC*)) /T) (Eq 3.14) 
solving for T yields 

T = — Max(AC’) / In(2y — 1) (Eq 3.15) 


In this approach there is no need to conduct empirical testing. One computation during map 
preprocessing can establish a common starting temperature for all problem instances. The major advantage 
here is the tendency for this method to be independent of problem instance, depending instead on the 
particular map. But it is conservative and can increase annealing running times unnecessarily. However, we 
emphasize that this approach is quite flexible. It is possible to conduct the analysis for Max(AC" ) on a subset 
of map edges confined to the vicinity of start and goal. This variation is more problem-instance dependent 
while still very efficient. 

The presence of obstacles, again, requires special consideration. Small obstacles with few 
boundary edges will not significantly effect transitions. However, larger obstacles can sometimes hamper 
lateral movement because they may require acceptance of large cost changes to jump. If we wish to set 
Starting temperature such that all obstacle rotations will be accepted in early annealing, it is necessary to 
analyze their worst-case cost differences also. Consider a single obstacle rotation. The worst transition tends 
to occur when the current WS is forced to detour completely around the obstacle from a single edge incident 
to it. To estimate the value of this worst-case cost difference, we compute cost of traveling on the boundary 
edges of the obstacle in a closed loop. From this we subtract the shortest weighted length edge of all its 
boundary edges to account for that portion of the cost incurred by the original path which passed near the 


obstacle. 


2. Stopping Criteria 
Freezing temperature, T, is the final value of 7 at which no significant cost-increasing transition 
has areasonable probability of acceptance. The reduction of unnecessary search time 1s as dependent upon T 


i 
as it is on T,. Once T is low enough, the current WS will trap in a local minimum from which it will likely 
never escape and in which it can never improve the cost beyond the lowest it has already discovered. At this 
point we desire that the process terminate soon. However, if it 1s still the case that T >> T, then the algorithm 
will waste a lot of time before it halts. 

How is it possible to determine the proper value of T, when it apparently depends upon a priori 
knowledge of the optimal solution cost and its location? Fortunately, annealing runs exhibit a few similar 
characteristics. An annealing curve is a plot of the mean solution cost vs the logarithm of temperature. Figure 
3.21 illustrates a curve which is typical of most annealing mins [Aart89, VanL87, Haje85, Whit84, Kirk83]. 
C,. is the average cost over all solutions sampled at discrete temperature 7. Note that the x-axis represents 


log(T) in the direction of time. Therefore, log(7T) decreases from left to right. Path-annealing curves tend to 
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be wavier at higher temperatures (left half of the curve) because the starting solutions reside in cost function 
valleys. Path annealing climbs in and out of many such valleys until the value of T is low enough to stabilize 
(by trapping) it within a localized area. However, at lower temperature path-annealing curves do resemble the 


tail in Figure 3.21. 


Cy = average cost over all solutions 
sampled at temperature T 





Figure 3.21. Annealing Curve: Average Cost at T vs. Log(T) 


One way to set T, dynamically is to extrapolate the end of the annealing curve by tracking the 
change in mean cost [Aart89]. This does not work well in path annealing since even with smoothing the mean 
cost can fluctuate significantly at very low temperatures. The suggestion of [Huan86] is simpler and a much 
better indicator of the freezing condition in path annealing. For a given 7, if the cost difference between the 
largest and smallest accepted transitions is the same (or very nearly so) as the largest accepted AC, then 
apparently all solutions in the neighborhood are of very similar cost. At this point, simulated annealing should 


default to iterative improvement and halt. To guard against premature freezing, we suggest that the above 


condition exist for two or three consecutive temperatures. 
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The above procedure stops the annealing algorithm dynamically. Recall that our prototype 
actually uses a fixed value for 7. However, we determined its value from many observations of path 


ii 
annealing using the criteria of [Huan86]. 


3. Temperature Cooling 


There are several sophisticated cooling schemes which have been devised for efficient, adaptive 
reduction of temperature [Huan86, Lund86, Aart85]. We prefer the more simplistic approach taken in the 
original work of [Kirk83], also adopted by [John89]. Three fixed parameters control temperature cooling: R, 
L, and L. 

The reduction or cooling factor, R, is a multiplier used to reduce T geometrically according to 

A pT, (typically 0.70 < R < 0.99) (Eq 3.16) 

This parameter controls AT, and thus, the speed at which the algorithm will approach T. In accordance with 
the underlying theory of simulated annealing [Kirk83] it is best to reduce 7 as gradually as possible with 
values of R closer to one. In any case, there is a tradeoff between time spent at each temperature value and 
the size of AT. Large AT approaches T relatively fast, but requires more ume at cach value of T. On the other 
hand, smaller AT approaches the stopping criteria much slower, but requires less time at each T. 

The amount of search time spent at each temperature is directly controlled by L. The chain length, 
L, is the maximum number of transitions attempted by the move generator at each value of T. The best value 
of L is generally believed to approximate the size of the local search neighborhood [Aart89]. The local search 
neighborhood is the number of distinct states (1.e. window sequences) reachable in transition one of the move 
generator. For path annealing the local neighborhood size is a function of the number of edges in a current 
WS, since the move generator selects transitions on this basis. However, in contrast to the cardinality of a 
solution set in other problems (e.g. the Traveling Salesman Problem), the number of edges in a WS changes 
frequently. Also note that WS length varies greatly with the number of bends, waves, and even cycles. 
Therefore, we suggest the employment of some average or other stable value representative of WS length. 

We could use the length of the starting WS found by A* search through midpoint paths. However, 
this WS is often biased and may not represent the size of most neighborhoods. Thus, for our testing we choose 
to use a fixed value for all problem instances of a map. A reasonable value for L can be derived from a map 
by using a sample of straight lines equal in length to the diameter of the map. L is computed by averaging the 


number of boundary edges crossed by each line over all lines in the sample. This procedure is essentially an 
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esumate of map resolution. Once again, the advantages are simplicity and problem-instance independence 
with an option to allow adjustments to L for particular problem instances if more efficiency is desired. 
Closely associated with L is the maximum number of accepted transitions per temperature, L.. 
Recall that a transition attempted by the move generator is accepted if its corresponding solution cost is less 
than the current solution cost, or with probability P (see Eq 3.11) if more. L. is referred to as a cutoff for L 
[John89]. The purpose of a cutoff is simply to compensate for overestimating the starting temperature, T,. We 
desire a minimum value for I, at which the acceptance ratio x = 0.95 (or very close to one). It is better to 
begin annealing at an overestimated value of Ty rather than risk the possibility of trapping too early in a bad 
local minimum. Assuming zi has been overesumated, until T approaches the proper value of Ts each 
consecutive sequence of L. acceptances will cause premature temperature reduction by Eq 3.16. L. IS 
essentially an annealing-specific heuristic devised by [Kirk83] to reduce search time spent at high 
temperatures [John89]. There appears to be little published guidance as to how to establish this parameter. 
Some forms of the annealing algorithm do not use it. In fact, [John89] claims that its effect is often 
insignificant, and its use is usually unnecessary if good starting temperatures can be found. We should expect 
some gain in efficiency by using a cutoff because our starting temperatures tend to be higher than necessary. 
Indeed, path annealing exhibits generally faster execution times with the same performance for (0.67)L < L. 


< (0.75)L. Note that use of this control parameter has no effect when L. = 


G. SUMMARY 

This chapter has presented the framework for a simulated-annealing-based algorithm designed to solve 
large instances of the WRP. We have discussed the theory and practical application of the algorithm in terms 
of its five essential components: 


¢ stale space representation 

¢ initial solution 

¢ cost function evaluation 

¢ move generation 

¢ annealing schedule 

We employ simulated annealing as a simple tool for the control of local search. In doing so, many of 

the specific design concepts (e.g. the annealing schedule) are adapted from previous research. Therefore, we 
emphasize that the significant contribution of our work is not in annealing, but rather in the novelty and design 


of our annealing-based approach to solving the WRP. Chapters I and II have already described several of the 


advantages offered by this algorithm over previous ones. 
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In Chapter IV we will discuss heuristic enhancements and bounds which are available to path annealing 
(and some other algorithms) to increase performance and efficiency. We believe this collection of heunstics 
and bounding techniques is another significant contribution to automated path-planning research and the 


WRP. 
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IV. EFFICIENCY ENHANCEMENTS TO PATH ANNEALING 


A. INTRODUCTION 

In optimization problems it is sometimes possible to predetermine absolute limits on the location or cost 
of an optimal solution. We refer to such limits as bounds rather than heuristics since the latter are generally 
not absolute limits. Both upper and lower bounds can reduce the search effort by restricting the set of 
solutions or partial solutions which an algorithm must examine. The WRP provides several opportunities to 
devise bounds by reasoning about geometric conditions in the input maps. When absolute bounds are 
inadequate to reduce the amount of search required to obtain solutions in reasonable time, heuristic guidance 
can be employed. Although there is no assurance that heuristic knowledge will always achieve its intended 
objective, good heuristics can be helpful [Pear84]. The next two sections examine bounds and heuristics 
designed to increase the performance of path annealing. Some of these also apply to systematic search 


methods. 
B. SEARCH SPACE BOUNDS AND CONSTRAINTS 


1. Bounding Ellipse 
In their systematic approach to the WRP, [Rich87] and [Rowe90b] implement a bounding box 
which is guaranteed to contain the globally optimal path. The box is actually a simplifying device that 
curcumscnibes a bounding ellipse whose foci are start and goal points. The bounding ellipse is based on the 
weighted cost of a feasible path from start, S, to goal, G, and the lowest cost coefficient on the map. For every 
point, P, on the ellipse, the straight-line path SPG weighted at the lowest cost 1s equal to the cost of the known 


feasible path. Figure 4.1 illustrates the ellipse inscribed within its bounding box. 
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Figure 4.1 Bounding Ellipse Inscribed within Bounding Box 


To compute the box, the implementation of [Rich87] determines the lengths of the major and 
minor axes of the ellipse. These lengths are functions of the known distance ISGI, the lowest cost coefficient 
and the initial solution cost. Referring to Figure 4.1, let rT be the lowest cost coefficient on the map, and let 


D be the weighted cost of the initial solution. Then the lengths of the major and minor axes are 


JD? -1SG\? 


ipo (Eq 4.1) 


minor — ul 
L major 


= (Eq 4.2) 
Ti 


These lengths, and the heading of the line from S to G, establish the edges of the bounding box. Any path (or 
partial path in systematic search) which intersects an edge of the bounding box (or ellipse) cannot be a 
globally optimal because the feasible path used to construct the box must be lower cost. Thus, the search 


space is absolutely bounded. 
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In path annealing we implementa true version of the bounding ellipse, which eliminates more area 
than the box. Path annealing can sometimes benefit greatly by eliminating even a few edges or edge parts 
from the search space; one less edge translates to combinatorially fewer WS’s. Furthermore, cutting a long 
edge in half results in about one half of the edge-points needed by UDP approximation each time this edge is 
evaluated in a WS. 

The cost of the initial midpoint solution retumed by A* search is an upper bound on the cost of 
the globally optimal path. However, we can usually improve this bound by applying UDP followed by SPR 
on the WS through which this midpoint solution passes. Let the resulting path-cost be D. The foci of the 
ellipse are the start, S, and goal, G. By definition, P is a point on the ellipse, if and only if the Euclidean 
distance of a straight path from § to P to G weighted by u, is equal to D. Thus, a point, Q, inside the ellipse 
obeys the following inequality: 

u (ISQI+IQGI) <D (Eq 4.3) 

We compute the exact ellipse as follows. Consider the two vertices, V : and Vos which define an 
edge on the map. Compute the cost of direct paths SV /)G and § VG weighted by the lowest cost, u. Let these 
costs be C yp and C, respectively. In comparing these costs to the ellipse defining cost D, there are three cases 
to consider, one of which has two subcases. Figure 4.2 outlines each case and the required action. Note that 
each boundary edge in the map is considered once. Usually only a small portion of the edges will require 
binary search. 
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For each boundary edge let C; and Cybe the costs of the SV,;Gand SV4G 
paths where V,; and Vzare the vertices defining the edge. 


To construct an exact bounding ellipse from initial solution cost D, there 
are 3 cases to consider: 


1. IF (C; < D) and (Co< D) 
THEN edge is inside ellipse 
Action: none 


2. IF (C,< Dand Co> D) or (C; > Dand Co< D) 
THEN edge intersects ellipse at one point 
Action: binary search between v; and v> to locate intersection 
update map database with new vertex for this edge 


3. IF (C,>D) and (Co> D) 
THEN edge intersects ellipse at two points 
OR edge is completely outside ellipse 
Action: locate point at which edge would be tangent to ellipse 
let that point be 7, the virtual tangent point 
compute S-7T-G weighted by lowest cost coefficient L1* 
let this cost be Cy 
There are 2 cases: 
IF (C;< D) 
THEN edge intersects ellipse at 2 points 
Action: binary search between V; and T 
binary search between T and Vo 
ELSE IF (C;> D) 
THEN edge outside ellipse 
Action: remove edge from map database 


Figure 4.2 Cases of Bounding Ellipse Construction Algorithm 
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The third case of Figure 4.2 indicates that it is sometimes necessary lo compute a virtual tangent 
point and then binary search for an intersections on both sides of the edge. The virtual tangent point is that 
point on the edge of consideration at which a smaller ellipse with similar shape would touch the edge. By 
similar shape is meant that the ratio of the major to minor axis lengths remains constant. Simple geometry 
and the properties of an ellipse can show that if the virtual tangent point of an edge lies inside the bounding 
ellipse, then the edge must intersect the ellipse in two locations (once at entry and once at exit). Note that 
relative to all start and goal point locations, every infinitely extended line (edge) in continuous two 
dimensional space which does not intersect the segment SG between start and goal points, must have a virtual 
tangent point. If the line intersects segment SG, then the virtual tangent is taken to be this point of intersection. 

The time required to compute the ellipse by our technique is O(e log(M/e)) where e is the number 
of map edges, M is length of the longest map edge, and € is the maximum allowable error in binary search. 
The ellipse bound is most effective in reducing search space when the initial A* solution is a high speed 
avenue which uses much of the lowest map weight. If such is not the case, then the ellipse may become fatter 
than the map itself. Even so, the time expended to check each boundary edge for the existence of an 
intersection is negligible. Furthermore, it is possible to determine if an initial solution cost can generate a 
bounding ellipse that lies within the confines of the map border. Given a standard map is 100x100 square 
distance units, if the lowest cost on the map n=l, then an initial path cost of 281 (= 100 * V2 * 2) or more is 
guaranteed to generate an ellipse larger than the map. In such cases, there will be no intersections. However, 
for an initial path cost less than 281, ellipse construction is usually worthwhile regardless of the outcome. If 
many intersections necessitate binary searches, then search space reduction will usually be significant. If not, 


we lose very litle time for intersection existence checks. 


2. Ellipse Improvement 


Once established, if the regions which determined optimal cost coefficient used to compute the 
ellipse are no longer contained therein, then a smaller ellipse can be computed on the basis of the new larger 
optimal cost coefficient within [Rich87]. Path annealing provides still another way to improve the ellipse. 
Since path annealing always examines complete solutions, the upper bound on the cost of the optimal solution 
can be reduced whenever a WS is found whose locally optimal path has lower cost than the best known 
solution. These upper bound improvements provide more opportunities to recompute and shrink the current 
bounding ellipse. Since some reductions to the upper bound may only be slight, it is better to prearrange a 


threshold for action on the ellipse. Recomputation of the ellipse should only be initiated when one or more 
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edges will be completely removed from the search space. A new ellipse which only shortens existing 


boundary edges without eliminating them does not remove window sequences from the search space. 


3. Edge-Pair Elimination 

The bounding ellipse is a global constraint on the solution space. On the other hand, we have seen 
that Snell’s Law is a local constraint on the way optimal paths cross boundary edges. Snell’s Law can 
determine regions through which globally optimal paths are not allowed to pass. Such regions may be 
idenufied independently of start or goal locations, as long as they do not contain either. This is very valuable 
knowledge since it is independent of the problem instance, and thus, computable as a map preprocessing 
stage. Such constraints can be used by both systematic and local search algorithms. Although path annealing 
is satisfied with finding near-optimal paths, local regions which cannot contain optimal paths have little 
potential for containing near-optimal paths. While unusual problem instances are possible, we focus on the 


horm. 


a. Shortcut Analysis 

We generalize and extend a particularly useful constraint that was first proposed in limited 
form as a search pruning criterion by [Rich87] and [Rowe90b]. What we refer to as shortcut analysis 
determines if any globally optimal path can cross a specified edge-pair. An edge-pair is a pair of crossable 
edges which bound a common traversable region, and, therefore, can occur consecutively within a WS. Note 
that since obstacle edges are not crossable, then they can never be part of an edge-pair. We can prove that for 
edge-pairs with certain geometric arrangements and cost coefficients, no optimal path can ever enter the 
region bounded by the pair from interior points of both edges. Note that this does not preclude the possibility 
of bypassing interior points and enter the region via its vertices. However, a path segment which crosses a 
region on a pair of its vertices is considered to lie in all WS’s that use this path as a left or right defining limit. 
Search space redundancy at vertex paths means that bypassing path segments will also be contained within 
other window sequences (WS). Interior crossings of edge-pairs eliminated by shortcut analysis need not be 
checked for globally optimal paths. 

Shortcut analysis considers each edge-pair of the map. Every edge-pair has an associated set 
of three cost coefficients. These coefficients correspond to the weights of the three distinct regions which are 
bounded by the edges in the pair. Referring to Figure 4.3, consider the edge-pair E -E , bounding common 


region R. The set of cost coefficients corresponding to Ss. is {ut plot): If uw 7 <Hy and H, < Hp» then we 
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consider R a high-cost region relative to E -E,. In sucha case, conditions developed in Theorems 4.1 and 4.2 


(Appendix A) dictate how to determine if E -E,, can be eliminated as an optimal-path crossing site. 





Figure 4.3. Shortcut Analysis on Edge-Pair E,-Ep 


The proofs of Theorems 4.1 and 4.2 permit us to use the following argument. In Figure 4.3 
consider the continuous subspace of path segments connecting edge-pair E -E, which cross through region 
R from interior points on each of E. and E re If the unweighted distance of one such path segment is 
represented by d/,, then Hod, represents its weighted distance. Also connecting each pair of interior points of 
E -E » are two perimeter paths, which detour around R by following along the edges bounding Ro, bypassing 
its interior points. Let the counterclockwise perimeter path be P ; and the clockwise path be P.. The weighted 
distances of P , and P, have both a fixed and variable component. The fixed component for each perimeter 
path is the sum of the weighted lengths of the bounding edges traversed by that path which are not in EE, 
LetD ; and D,, represent these fixed weighted-length components for P , and me respectively (see Figure 4.3). 
The variable components are dependent upon the path segment crossing Ro. Let d , and d, represent the 
variable-component perimeter-path distances from the crossing points on E. and E Pe Then 4 j and [d, must 
represent the corresponding weighted distances. 

For the moment we will assume that regardless of the crossing location the cost of using P ] 


will always be less than the cost of using P,. To see why it may not be possible for a globally optimal path to 
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cross R using interior points of E -E Fie consider the implication of proving that the ratio of the cost of P , 0 

the cost of crossing through R is always less than 1: 
D,+U,d,+p,4, 

> —<$— —— ____—_ (Eq 4.4) 

Ho 


Using the interior angle a of E -E Ae the fixed distances s and ¢ from the projected intersection of E, and E - 


and the Law of Cosines, Eq 4.4 can be rewritten so that L is a function of the crossing location on EE, as: 
ahs D,+u,4,+H,d, 

oy 

J (S+d,)7+ (t+d,)2-2(s+d,) (t+d,) Cosa 


If Eq 4.5 is satisfied for ail values of d , and d, along E_ and E, respectively (i.e. for all path segments in the 


(Eq 4.5) 


subspace), then a path segment through R from interior points of EE rs will always be more expensive than 
a perimeter path. This function has a maximum value which can be found using partial derivatives with 
respect to d ; and d,. If the true value of LH, exceeds this maximum value, then no optimal path can cross 
through region R using interior points of E -E ; because a perimeter path is al ways cheaper. 

Theorems 4.1 and 4.2 in Appendix A cover mathematical details. The constraints provided 
by these theorems can tag or eliminate from a weighted-region map edge-pairs which cannot have an optimal 
paths crossing them. Eliminating very many edge-pairs can reduce the search effort required of systematic 
search algorithms, including the A* search of the edge dual-graph used by path annealing to establish an 
initial solution. Though crude, the A* search for an initial solution is a major part of path annealing. 
Therefore, constraints on the size of the edge dual-graph which enhance A* search efficiency will benefit path 
annealing as a whole. For many problem instances it returns the window sequence very close to or containing 
the globally optimal path. The sooner annealing can find an optimal or near-optimal path, the more valuable 


the algorithm becomes in the case of time-constrained execution. 


b. Critical Angle Analysis 
Sometimes the geometry of an edge-pair is such that we can avoid tedious computations 
required for shortcut analysis, while still eliminating the edge-pair. This is particularly true when the interior 
angle a between an edge-pair is close to m radians. Critical-angle analysis is a Snell’s-Law based technique 
which uses the critical-angle rays from the four vertices of an edge-pair to determine if any reflective path 
from either edge can intersect the other. If not, then it follows that no Snell’s-Law path can exist between 
interior points of the edges because the critical angle is the limiting case of Snell’s-Law bending on the high- 


cost side of a boundary edge. Since all optimal paths which cross the interior points of a boundary edge (not 


te, 


at a vertex) must obey Snell’s Law, then no optumal path can cross between interior points of the edge-pair. 
Thus, the edge-pair can be eliminated. This is similar to the concept of shadowing in [Ross89]. Shadowing 
refers to the propagation of constraints which restrict possible movement directions. 

A typical situation for critical-angle analysis is depicted in Figure 4.4. Note that Uy <H, and 
Hy <B,» otherwise reflection cannot occur from within region R. An algorithm to implement critical-angle 
analysis begins by computing four rays, each of which emanates from a different vertex in edge-pair E-E 7 
The direction of each ray must be inward toward the interior angle @ and must form a critical angle with 
respect to the edge from which it emanates. Next, the intersection points P r Pas P,, and P of the four rays 
with the opposing edges are computed by assuming that edges E. and E A extend infinitely. Finally, check the 
positions of the intersection points relative to the vertices of the edge segments. If both pairs of intersection 
points lie completely to one side or the other of their respective line-segment vertices, then no Snell’s-Law 


path can exist for E -E A and it can be tagged such. 


region Ro 





Figure 4.4 Critical-Angle Analysis of Edge-Pair E,-Eg 
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c. Virtual Obstacles 

A given region cost coefficient may be so high relative to its surrounding environment that 
all of its edge-pairs can be eliminated from the solution space. Such regions are called virtual obstacles 
[Rowe90b]. Virtual obstacles are equivalent to real obstacles, unless the start or goal resides within. It is 
possible to flag such regions and generate obstacle edge-lists so that they may be jumped during annealing. 
On the other hand, this may not always be prudent. Recall from Section III.F.1 that large obstacles can hamper 
the ability of annealing to move freely over it because large cost-increasing transitions may be required to do 
so. During high-temperature this would be bad for annealing, since the search should explore the solution 
space across as broad an area as possible. We discuss other ways of handling this situation in the next section 


on heuristics. 


C. HEURISTIC IMPROVEMENTS 

We have discussed restriction of the WRP search space using both global and local constraints. These 
are strong restrictions because they provide an absolute guarantee that no globally optimal solution will be 
excluded. We now present several heuristic techniques which can improve the performance of path 
annealing. Heuristics are “rules of thumb" which strike a compromise between being simple and making 
correct choices [Pear84]. Since it is probabilistic and, therefore, cannot guarantee the global optimum, 
simulated annealing is itself a heuristic approach. Furthermore, for other optimization problems, the 
annealing technique usually requires larger execution times [Naha85]. However, the heuristic enhancements 
to be discussed demonstrate the capability to reduce execution times significantly while improving the cost 
of the final solutions. In combination these heuristics make path annealing very competitive with pure A* 


search algorithms, particularly in larger problem instances. 


1. Rapid Cost Function Evaluation 

Recall from Chapter III that to find the locally optimal path within a window sequence is a two 
Step process. The uniform-discrete-point (UDP) technique retums an optimal path constrained to discrete 
points spaced at an interval 6 on each edge in the window sequence. Subsequently, beginning from this 
approximation, single-path relaxation (SPR) uses a Snell’s-Law lookup table to iteratively adjust crossing 
points until no further improvements can be made. For a single window sequence (WS), the procedure is 
relatively efficient. However, it becomes less so when we consider that the cardinality of the set of all WS’s 
is at least O(v2") where v is the number of interior vertices in the map [Rowe90b]. Thus, we examine heuristic 


methods designed to increase the efficiency and frequency of cost function evaluation. 


8] 


a. Relaxation Threshold 

In a combinatorial opumization problem the distribution of the number of states having a 
given value of cost is called the density of states [Whit84]. For some large complex problems the density of 
States resembles the shape of a normal distribution function where the tails represent global extremes — the 
number of maximum cost states on the right and minimal cost states on the left (see Figure 4.5). Having 
bounded the search space (either by a bounding ellipse or by the natural border of the map) and using a move 
generator which tends to remove cyclic WS’s, we may expect a WRP instance to have a similar density of 
States, where each State is a window sequence (WS) and its cost is the cost of its locally optimal path. The 
stochastic nature of the simulated annealing algorithm requires that we evaluate every state (i.e. WS) 
encountered in search. However, a relatively low density of optimal and near-optimal solutions suggests that 
frequent applications of single-path relaxation are unnecessary. Although upward biased, uniform-discrete- 
point (UDP) approximation is fast and gives a reasonable estimate of the single-path relaxation (SPR) result. 
For most WS’s, UDP approximation suffices to estimate their nearness to a global optimum. Furthermore, 
that UDP approximation can sull effectively guide an annealing-based search is confirmed by other 
researchers who have observed that exact cost function evaluation is not always necessary [Tove88, 


Adam8s5§5]. 
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Figure 4.5 Density of States: Number of States in Cost Interval C; 


82 


On the other hand, we do not want path annealing to overlook an optimal or near-optimal 
solution if it happens to sample one. This could happen since the cost returned by UDP is only an 
approximation. To control this possibility, we establish the relaxation threshold, C”+Ak, where C’ is the cost 
of the best known solution (also the current upper bound on the optimal solution cost). The second term, Ak, 
is a fixed value established at the start of path annealing. The relaxation threshold represents the condition 
which triggers single-path relaxation: if the UDP cost is less than or equal to C’+Ak, then SPR is applied to 
determine if the refined cost of this WS can improve C " 

To determine the fixed value of Ak for a given problem instance, we assume a worst case 
situation for a UDP approximation based upon the discrete spacing of edge-points, 6. Since UDP must 
consider only paths constrained to cross at edge-points, then it can be forced to return an approximation with 
path segments which detour in non-optimal directions. For relatively straight WS’s, the worst error in UDP 
approximation generally occurs where the algorithm must select path segments whose directions are 
perpendicular to the optimal direction. The least flexibility for choice of segment usually occurs in the start 
and goal-containing regions, because the start and goal are fixed points. Toward the middle of the window 
sequence more flexibility is available, and more path segments exist which are less perpendicular to the 
optimal direction, and which tend to self-correct and dampen the effects of errors made at the start and goal. 
Also, consider the locally optimal path of a window sequence (WS) which has many bends. More bending 
generally implies that the locally optimal path will cross many end points (vertices) of boundary edges. Since 
the edge-points used by the UDP approximation always include the vertices of a boundary edge, error is 
minimal at these locations. 

Based on the foregoing discussion, we relate Ak to 6 and the cost coefficients of the start and 
goal-containing regions. Figure 4.6 illustrates a WS in which a locally optimal path (dotted) is approximated 
by a UDP constrained path (solid). Edge-points are shown as solid circles. We have constructed this figure 
so that the locations of start and goal points force initial path segments from start and goal in the UDP 
approximation to be almost perpendicular to the true optimal direction. Under the assumption that this 1s the 
worst case UDP approximation for 6 spacing and L. and H, for start and goal-containing regions, then the 
maximum difference between the UDP and SPR costs through this WS is 0.50(H, +1). Our empirical 
observations using vertex rotations only (i.e. proper WS’s) confirm this calculation. Being conservative, we 
define 


Ak = 0.55Q +1) (Eq 4.6) 
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Figure 4.6 Uniform-Discrete-Point Approximation of a Locally Optimal Path 


The reentrant installation operator has a special relation to the relaxation threshold. For WS’s 
with reentrant paths, the cost difference between its UDP approximation and SPR may grossly exceed Ak. 
This happens when a reentrant-installation move is accepted by the annealing process, but this move does not 
improve cost. This is because UDP is forced to reflect on edges installed for reentrant paths whether or not 


they are improvements, while SPR simply ignores such reentrant edges. This does not invalidate our 


84 


calculation of relaxation threshold, because these reentrant WS’s reside in the middle to upper ranges of the 
density distribution, and therefore never contain optimal paths. However, when a cost-improving reentrant 
occurs, the cost difference between UDP and SPR for it does not exceed Ak. Therefore, an optimal reentrant 
path will be recognized if its UDP cost is below the relaxation threshold, C’ +Ak. 

The relaxation threshold provides two advantages for path annealing. First, as implied earlier, 
it indicates when a WS cost is far enough from C” that a refinement with SPR is guaranteed to be useless. 
Furthermore, as C’ is updated, the frequency of SPR application will tend to decrease. This results in a 
significant time savings at high temperature. As temperature T decreases, SPR may be required more 
frequently. The second advantage results from the global effect of UDP approximation. It is generally 
recognized that simulated annealing performs best in a search space with a smooth cost function [John89}. 
Although UDP approximation raises the relative costs of all WS’s, it tends to raise the larger ones less because 
their bending usually causes locally optimal paths to pass through many vertices. Recall that vertices are 
always available to UDP as edge-points, and crossings through them will be very accurate. Thus, to the 
annealing process the search space tends to be globally smoother, except where there is good potential for 


optumal or near-optimal solutions. 


2. Caching Path Costs and Window Sequences 


It is possible to stumble upon the globally optimal WS and corresponding path during annealing. 
So it always makes good sense to maintain a record of the best known path and update it as necessary. At the 
conclusion of annealing, the final solution returned will be that with the best known cost, C”. While this is 
not standard annealing, most researchers use this variation (e.g. [Carr90, John89, John90)). 

The number of proper WS’s in a map is at least O(2") where v is the number of interior vertices. 
Relative to many of the NP-Hard problems, this is not an exceptionally large search space. Bounds and 
constraints (e.g. the bounding ellipse) can shrink the space even more. Therefore, path annealing quite often 
Can repeat cost function evaluation on a WS it has already evaluated before. Recall that cost function 
evaluation is an expensive operation. Therefore, caching path cost for WS’s avoids unnecessary uniform- 
discrete-point approximations. Before any WS is evaluated (with UDP search or SPR), a hash value is 
computed as a function of the edge identifiers in the WS. This function may include all identifiers in the 
sequence or some predetermined subsequence. The hash value is used to check the cache of previously stored 
WS’s and their associated costs. If the WS is found in the cache, then its cost is returned without 


recomputation. Otherwise, WS cost function evaluation proceeds, and the results are cached for future use. 
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Although we have explored only a few hash functions, we find that better performance results 
from those which are computationally simple rather than those which represent elaborate attempts to 
minimize collisions. Our prototype computes a hash value as the sum over all integer edge-identifiers in the 
WS (except for s and g). Collisions are handled by linear chaining of linked lists. Limited experiments 


indicate that use of this hash function results in a 20% to 30% savings in path annealing execution me. 


3. Move Generator Heuristics 

The generation of transitions generally requires less work than does cost function evaluation. This 
is a result of the data structure support discussed in Chapter ITI. However, since move operators are the means 
by which annealing traverses and samples a large solution space, their design is very important to annealing 
results. Good operators are apparently difficult to design because problems and applications vary widely 
[John89]. For example, annealing on the Traveling Salesman Problem has been tested with several different 
operators, and some perform significantly better than others [Otte89]. In path annealing, we desire that the 
move generator be capable of causing rapid movement, over a broad area of the search space, and with as 


little repetition as possible. To enhance these qualities, we introduce several heuristic techniques. 


a. Reduction of Repetition 

Recall from Chapter HI that to maintain transition efficiency, we designed only two very 
simple move operators: rotation (over a vertex or an obstacle) and reentrant installation. We also implied that 
the cumulative effects of single applications of these operators over ume uSually result in great movement 
across the search space. However, when a single vertex has many edges incident to it, a WS which crosses 
several of these edges can often waste time rotating back and forth across the vertex. The effect 1s simular to 
a physical standing wave. In general, the larger the number of edges incident to the vertex, the larger the 
probability that this vertex will be chosen as the site of rotation (See Figure 4.7). Caching of WS’s helps to 
reduce wasted ume, but does not prevent each repetition from counting as an attempted transition, thereby 
incrementing the annealing chain parameter, L (see Section III.F.3). While some repetition is good and allows 
annealing to return to more promising locations for more thorough search, the standing wave effect represents 


a Stagnation in the sampling effort. 
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Figure 4.7 Vertex V with Many Incident Boundary Edges 


To lessen the probability of window-sequence standing waves, for each attempted rotation 
we induce one additional rotation. This is done by randomly selecting an edge in the new WS that is incident 
to the original rotation vertex, and forcing rotation across its other vertex. With this technique we have 
essentially spread the selection probabilities over a wider range of edges, making it more unlikely that a 


random rotation will undo the transition of its predecessor. 


b. Relation of Move Operators to Temperature 
The double rotation technique discussed in the last section tends to cause broader movement 
across the search space than single rotations do. For some problem instances, we find that use of double 


rotation results in the discovery of lower cost paths (even the globally optimal path) more often. The 
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explanation for this lies in the relation of the magnitude of the attempted transitions to the annealing 
temperature. [Whit84] indicates that better annealing performance results from matching move size to 
temperature. High temperature annealing should attempt larger scale moves, while low temperature annealing 
should attempt smaller scale moves. The intuitive explanation for this is that at high temperature the higher 
acceptance rates will permit uninhibited sampling of the solution space. At this time, large moves are the most 
efficient means for moving quickly over a broad area of the space and will be accepted more easily. At lower 
temperatures it is inefficient to attempt large moves. Since they usually cause great changes in the cost 
function, many will not likely be accepted, especially if the annealing process has already found a reasonably 
low cost state. On the other hand, small scale moves can refine such a state efficiently by making local 
improvements or by climbing out of localized minimums which are not as good as others close by. 

Our prototype does not attempt to dynamically adjust or synchronize the move size with 
temperature. The effects of doubling vertex rotations seem to indicate that introducing multiple rotations at 
high temperatures could improve path annealing performance. However, the next two sections explore 


tunneling and cycling which are alternate methods for scaling up transition size for high temperature. 


c. Tunneling 

A sequence of neighboring window sequences within the WRP solution space which have 
similar costs that are relatively low compared to the surrounding environment 1s called a high-speed corridor. 
A given problem instance may have several high-speed corridors. Furthermore, these corridors may be 
separated by short or long physical distance, and by high or low weighted regions. In some instances high- 
speed corridors cross over one another, possibly in multiple locations. Path annealing gradually tends to focus 
its attenuon on one or more of these corridors as temperature decreases. The assumputon is that during high 
temperature, the annealing process will have spent enough ume roaming around all high-speed corridors to 
determine which would be best to refine at lower temperatures. Thus, at some low temperature the current 
WS will have committed to particular corridors from which it will likely not escape. 

This is essentially the behavior we desire. However, consider the following question: Have 
other high-speed corridors been searched as thoroughly as the one in which the process has settled at low 
temperature? The answer to this question depends upon the starting temperature, uy and the annealing chain 
length, L, the parameter defining the number of moves that will be attempted at each temperature, T. Recall 
from Chapter II] that our method of setting i ensures that the transition acceptance rate will be 95%. This 


implies that the means for finding virtually all high-speed corridors is available. However, L should be large 
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enough to ensure exploration of such corridors is sufficient for annealing to select and refine the good ones 
at lower temperatures. In theory the parameter L should be some function of (most often equal to) 
neighborhood size [Aart89]. However, in practice good values for L apparently vary from one application to 
another and should probably be set empirically [John89]. 

Extending annealing chain length, L, or raising starting temperature, T only risks longer 
execution times with little additional assurance of successfully finding and searching the best high-speed 
cordors. Instead, we suggest two techniques which take advantage of the fact that the WRP represented as 
a dual edge-graph has a smaller search space relative to many NP-Hard problems. 

The initial WS returned by A* search of the dual edge-graph usually corresponds to the 
location of a high-speed corridor. As we have said before, this initial WS can, but does not necessarily have 
to contain the globally opumal solution. Either way, we assume that it has a relatively high likelihood of being 
in close proximity to the optimal path. Now suppose we determine the n shortest midpoint paths and their 
corresponding window sequences in the dual edge-graph. Under the above proximity assumption, path 
annealing started from each of these window sequences at a lower value of Ty will have a higher probability 
of locating the optimal path. However, we must be careful. The second (and third, etc.) shortest midpoint path 
within the dual edge-graph may very well reside within the very same high-speed corridor containing the first 
shortest midpoint path. If so, then we are simply wasting time finding n best paths which annealing will 
probably examine anyway because they are all very close together. Therefore, what we really desire are the 
n most high-speed corridors, which may or may not be the n shortest midpoint paths. This reasoning is very 
similar to what [Tove88} refers to as a neighborhood prejudice swindle. The basic objective is to reduce 
computing time and increase the likelihood of finding good solutions by concentrating on the most promising 
neighborhoods. 

To find a second corridor, we can use knowledge within the initial WS. The WRP optimal 
paths maps generated by [Alex89] reveal that for a given fixed goal point, the vertices and boundary edges of 
low-cost regions tend to attract many optimal paths. Relatively high-cost regions tend to repel them. On the 
basis of this observation, we can find a second high-speed corridor which is physically separated from the 
initial by forcing a second A* search to avoid the edges of regions most responsible for making the initial 
solution low-cost. Therefore, by temporarily removing one or more long, low-cost edges from the original 
dual edge-graph, a second A* search is driven to find an alternate low-cost midpoint path which is usually in 
a different corridor. The procedure is equivalent to temporarily blocking a high-speed corridor with one or 


more large obstacles. If the second WS lies very near the initial WS, then this is strong evidence that this 
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corridor contains the optimal path, since A* search was not able to find a corridor with regions low enough 
in weight to draw it away from the first. 

At least one of the edges chosen for temporary removal from the graph must be within the 
initial WS. Otherwise, the second A* search will return the same WS. In general, the edge in the initial (or 
previous) WS which bounds the start or goal-containing region is the one whose removal will maximize the 
difference in physical location between successive A* search solutions. The reason for this is that removal of 
such an edge usually forces a large shift in the initial direction of search from the initial region (containing 
the start or goal). Consequently, the resulting midpoint path may have to use low-cost regions in areas of the 
map which were not advantageous when leaving the initial region through the removed edge. 

Having located several different high-speed corndors, the annealing process may proceed 
from a lower temperature either sequentially starting from each or concurrently on all high-speed corridors 
together, returning the best path found over all. Concurrent execution would require that one initial WS be 
selected as the starting solution. Since there would be n independent current window sequences, several 
possibilities exist for concurrency. We could apply random transitions by queuing the current WS’s. Or the 
move generator could randomly select one current WS on which to apply a move operator. We could control 
random selection of a current WS by annealing for a short interval of time (perhaps random), after which 
annealing shifts to a WS representing a different corridor. Each time this shift is performed, the algonthm 
effectively tunnels through high-cost peaks in the solution space. One way to trigger tunneling is to treat it as 
another move operator. It could also be driven by results in the current corridor. For example, tunnel to 
another WS if the current cost has not improved after n consecutive transitions. There are certainly many other 
possibilities for multiple-corridor execution. Our prototype implements only a single initial A* solution. 
However, we have observed that a second corridor generated as described above increases the capability to 
locate optimal paths. 

We can also implement tunneling by relying upon high temperature annealing to locate 
several WS’s representative of different high-speed corridors. Later at lower temperatures annealing may 
tunnel back to these corridors via the WS’s. Since we cache each new WS along with its uniform-discrete- 
point estimated cost, the process can actually tunnel to any WS of its choosing. One problem with this method 
of tunneling is that it may require very high starting temperatures to ensure broad uniform coverage of the 
map and discovery of high-speed corridors. Annealing can easily sample WS’s which are generally physically 
close together in one corridor, separated only by a few small cost gradients. However, movement to other 


corridors may require jumping one or more very high cost peaks. Larger transition size can help to induce 
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greater WS movement (for example, by allowing multiple vertex rotations for each transition attempted by 
the move generator). But to climb higher cost gradients still requires higher temperatures. We can save time 
by finding and caching the locations of WS’s representing high-speed corridors at the start of path annealing, 
This avoids the me otherwise required by annealing to climb the upward gradients between these corridors. 

Recall that for efficient tunneling we desire a set of WS’s which lie in, and thus, represent 
distinctly different high-speed corridors. Therefore, between WS’s, we need some measure of physical 
similarity or proximity within the search space. Window sequence (WS) costs alone cannot distinguish 
physical location. One simple measurement is to determine the set of regions entered by each WS and 
compute the set difference between them. If the resulting set is empty or has very small cardinality, then the 
WS’s probably belong to the same corridor. Otherwise, they are sufficiently distinct. With data structures to 
support edge to region translation, such a comparison could be relatively efficient. 

Our prototype employs a very limited form of tunneling. It records each WS found to contain 
a path whose cost is lower than the currently best known. The program does not check that these WS’s 
represent distinct corridors. Often they do not; however, if several WS’s have accumulated by the time the 
freezing temperature, 7, is reached, then the set usually represents more than one corridor. At temperature 
equal to T, the program sequentially tunnels to each WS in this set. To each WS it applies pure iterative 
improvement by attempting L random transitions. At this stage the relaxation threshold is no longer active, 
and single-path-relaxation (SPR) is applied to each WS. The best path found overall is returned as the 
solution. Although this technique also depends upon the ability of high temperature transitions to reach major 
high-speed corridors, it does give some assurance that locations in which good solutions were discovered 


early have been more thoroughly explored. 


4. Faster Initial Solutions 

A* search through the edge dual-graph to obtain a starting solution is a major component of path 
annealing. Although its resolution is crude (midpoints only), this phase of the algonthm generally accounts 
for roughly 10% of total execution time. In Chapter III we argued that starting annealing from the shortest 
midpoint path is most appropriate. However, we also mentioned that the primary purpose of A* search 1s to 
obtain a feasible starting solution. Having one of the best solutions helps, but is not necessary. 

Suppose we desire to implement tunneling using A* search to locate five high-speed corridors 
(first method of tunneling). Assuming that one A* search requires 10% of the total execution time, the total 


amount of time required to locate five corridors now exceeds 50% of the total path annealing execution ume. 
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This time may sometimes be reduced by reusing partial paths left on the agenda generated by the first A* 
search. However, if the time required to obtain initial corridors approaches 50% (or more), then we might 
reconsider whether the time advantages of our stochastic approach are still worthwhile. As Chapter V will 
demonstrate, such execution times are still less than the tumes required for a more refined global A* search 
from start to goal with a resolution capable of discovering the optimal path. 

However, with heavier dependence on the annealing phase of the algorithm, we can improve the 
crude A* search for starting corridors. Recall that admissible A* search computes an underestimate to the 
goal for each midpoint it reaches. This underestimate is the product of the straight-line distance remaining to 
the goal and the lowest cost coefficient, L, and ensures that the search returns the shortest (midpoint) path. 
If we assume that no path exists between start and goal which can travel exclusively in the regions of weight 
Lu, then we may relax the value of 1 by enlarging it. If our assumption 1s correct for a higher optimal cost 
coefficient, then the A* search remains admissible and sull returns the shortest midpoint path. If it is incorrect, 
then the A* search will be inadmissable, and the midpoint path may not be the shortest midpoint path. 
However, we have saved some ume in finding an initial solution in exchange for gambling on the ability of 
annealing to start from a possibly bad solution and still find a good one. 

In every problem instance some threshold value for the optimal cost coefficient exist which 
removes admissibility, and consequently, the shortest-path guarantee. Values higher than this threshold will 
generally cause A* search to overestimate weighted distance to the goal from more of the midpoints. In turn, 
the search 1s driven to the goal more directly and more quickly, because the overesumate increases its depth- 
first behavior. Using conservative optimal-cost-coefficient overestimates coupled with temporary removal of 
low-cost boundary edges from the dual edge-graph, is a good way to efficiently obtain an initial set of WS’s 


representing different high-speed corndors. 


5. Heuristic Bounds on Search Space 
Section B.1 of this chapter described our method for constructing the bounding ellipse of [Rich87] 
and [Rowe90a] which restricts the WRP search space. Recall that we use the lowest cost coefficient, Lu, in 
this calculation. The use of L is conservative and safe, and results in a bounding ellipse which cannot exclude 
any portion of a globally opumal path. However, more complex maps may have cost coefficients which vary 
over a wide range of values. For such maps, we indicated that the bounding ellipses for many problem 
instances are often larger than the map itself. This holds true even when the ellipse is computed on the basis 


of a globally optimal path. The reason is that for a given arrangement of start and goal, travel through the 
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lowest-cost regions may require detours through high-cost regions which nullify their efficiency. 
Unfortunately, determining if or when an arrangement of start and goal can efficiently use the lowest-cost 
regions of a particular geometry appears to require solving the WRP. 

To constrain a bounding ellipse to its minimal size requires a priori knowledge of the optimal path 
cost. Assume that for a given problem instance we have such knowledge. Let the cost of the optimal path be 
C’. Also, let the total unweighted length of the optimal path be D”. We define its average path weight as 

ut=C/D. (Eq 4.7) 

Average path weight is a rough measure of path efficiency. If the globally optimal path has very low average 
path weight, then the locations of start and goal are apparently favorable to use of many low-cost regions 
(not necessarily including the lowest cost region) and the optimal path is very efficient. On the other hand, if 
the optimal path has very high average path weight, then low-cost regions either do not contribute 
significantly or their efficiency is overshadowed by passage through high-cost regions. With the value of 1” 
we Can construct a bounding ellipse which is smaller than that which uses the lowest cost coefficient. Figure 
4.8 illustrates what we refer to aS a 1" -ellipse. 

As implied earlier, we cannot compute a 1" -ellipse without prior knowledge of the optimal path. 
Using the A®* search through the edge dual-graph we can obtain a least upper bound for C : Ideally, we desire 
a greatest lower bound on 1". However, we settle for a heuristic approximation for 1". Then, in exchange for 
a small risk of overlooking the optimal path, we can often achieve a marked performance improvement due 


to a more restrictive search space. 
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Figure 4.8 [1*-Ellipse 


One fast, yet conservative method of approximating 1” is to use the initial window sequence (WS) 
returned by A* search. Although crude (midpoints only), this search has entered most regions of the space in 
the immediate vicinity of start and goal, so that, intuitively, it provides a reasonable assessment of the 
distribution of cost coefficients between start and goal. Let the locally optimal path cost within this inital WS 
bee grand let its total unweighted length be D g an upper bound on the globally optimal path cost. To establish 
a conservative estimate for 12” we make a simple heuristic assumption about the upper bound for the globally 
optimal path-cost. Similar to the reasoning used to determine relaxation threshold in Section C.1.a, we 
compute 

AK = O51 +H nax (Eq 4.8) 
where /_ is the length of the longest edge bounding the start and goal-containing regions with cost 
coefficients p and M, respectively. A heuristic least upper bound on the optimal path cost is C 9 AK . Figure 


4.6 shows why the discrete interval 6 is used to determine relaxation threshold. Initial A* search through 
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midpoint paths is much less refined than UDP through edge-points with a spacing of 6. Therefore, the factor 
0.58 in Eq 4.6 is replaced by O.51 oe to obtain Eq 4.8. From the above we estimate 1" as: 

p* = (C,-AK)/D, (Eq 4.9) 

This comes from the observation that optimal paths generally do not stray unreasonably far from 
the regions between start to goal. In military operations there are often considerations which prohibit 
movement along paths with such extreme detours (for example, designated areas of operation or the 
requirement for adequate maneuver space between units). Also note that the procedure is useful for both path 


annealing and systematic search approaches. 


D. SUMMARY 

In this chapter we have presented and discussed some techniques which can improve the performance 
of path annealing. The prototype we have designed employs most but not all of these enhancements. We have 
concentrated on bounds and heuristics which have shown the most potential to maximize execution speed and 
probability of location optimal paths. 

Throughout the first four chapters we have stressed the performance advantages of path annealing over 
purely systematic search methods such as A* search. In Chapter V we will present our own version of a global 
systematic search algorithm which is similar to but faster and more accurate than the wavefront propagation 
algorithm referenced in Chapter II. It is against this algorithm that we compare path annealing. 

We wish to emphasize that path annealing, though primarily a stochastic algorithm, makes important 
use of A* search. In fact, it is fair to say that path annealing draws a major part of its performance and power 
from its A* search component. Rather than just another application of simulated annealing, we prefer to 
describe path annealing as an intelligent marriage of both systematic and local search (both continuous and 
discrete) under probabilistic control. Chapter V will present empirical results from testing of our path 


annealing prototype. 


2S 


V. EMPIRICAL STUDIES 


A. TEST PROCEDURES AND MAPS 


1. Input Maps 

To gain some understanding of how path annealing performs at different levels of input map 
complexity, we tested the algorithm on four maps. These maps (Figures 5.1, 5.2, 5.3, and 5.4) represent three 
levels of increasing complexity in terms of resoluuon and cost coefficient range. Cost coefficients are shown 
as integers within respective regions, and obstacles appear as gray areas in each map. 

Map1 (Figure 5.1) is the least complex, and represents synthetic terrain created and used by 
[Rich87]. Map2 (Figure 5.2) is of medium complexity and also represents synthetic terrain of our own design. 
Map3 and Map4 (Figures 5.3 and 5.4) are the most complex test maps. These maps represent our own 
weighted-region interpretation of a 1000 meter grid square of actual terrain extracted from a standard military 
map of Fort Hunter-Liggett, California [Defe74]. Using a computer-assisted tool (see Appendix B 
mapmaker.pl), we constructed these maps on the basis of combined elevation, vegetation, and terrain feature 
data. Figure 5.5 is a plot of the elevation data used to make Map3 and Map4. Figure 5.6 is a magnified 
reproduction of this area as it appears on [Defe74]. Figure 5.7 is an aerial photograph of the area taken by 
aircraft. Map3 and Map4 represent the same section of terrain in different seasons. Map3 represents a wet 
season during which the reservoir (large obstacle in the left half of Map3) is full. Map4 represents a dry season 
during which the reservoir is completely dry (the case at the tme of this writing). The validity of these maps 
was also confirmed by a site visit. However, we wish to emphasize that the cost regions assigned were of 
necessity Our Own interpretation of combined topographic effects. 

In an effort to ensure unbiased testing, we have also created three additional test maps (Figures 
5.8, 5.9, and 5.10) with the geometry of Map4, but in which cost coefficients have been randomly scrambled. 
The topological character of each map is identical to Map4. However, to create Map5, Map6, and Map7 we 
randomly assigned integer cost coefficients from the sets {1,2,3,...,10}, {1,3,5,7,9}, and {1,4,7} respectively. 


These maps are intended to test cost functions with varying degrees of smoothness. 
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Figure 5.5 Plot of Elevation Data Used to Create Map3 and Map4 
(elevation above Sea level; tick marks represent 12.5 meter intervals) 


Figure 5.6 


(aeeeceiiee 


e@eneeoae, O08 

evsauneaeece 
eseeeaee eeearse 
seuntoneaseate 





Extract of Military Map [Defe74] Used to Create Map3 and Map4 
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Figure 5.7. Aerial Photograph Used to Create Map3 and Map4 





Figure 5.8 Map5 
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2. Control Algorithm 

In Chapter II we discussed previous approaches to solving the weighted-region problem (WRP). 
To measure the performance of path annealing, we would like to place it in direct competition with these other 
WRP algorithms. However, most of the existing algorithms have limitations which prevent direct comparison 
on the test maps we have designed for path annealing. The Continuous Dijkstra Algorithm [Mitc90] has never 
been implemented. The Recursive Wedge Decomposition prototype of [Rich87] is limited to maps with two 
distinct cost coefficients and obstacles. Furthermore, it is not designed to handle maps in which vertices have 
more than two incident boundary edges. A future update to [Rowe90b] and [Alex90] will include a revised 
prototype to account for these restrictions. However, this prototype will construct optimal path maps instead 


of solving for specified start/goal pairs. 


a. Wavefront Propagation 

A limited comparison of path annealing to some of the empirical results of [Rich87] 1s 
possible using Map1. Recall that Map! is taken directly from the work of [Rich87]. We can compare solution 
quality directly in terms of total path-cost and physical location for identical problem instances. However, a 
direct comparison of execution umes is difficult since different machines and Prolog dialects have been used. 
Nevertheless, we can compare timing results with [Rich87] indirecUy through the grid-based wavefront 
propagation algorithm. To do so, we have written similar code to perform branch-and-bound search on an 8- 
neighbor lattice graph representing the homogeneous-cost regions of Map1. 

To provide the maximum advantage to the wavefront algorithm, the search graph and all 
weighted distances are precomputed independently of the wavefront algorithm itself. The cost of each arc in 
the graph is the product of its Euclidean length and assigned weight. For an 8-neighbor implementation there 
are only two lengths: R and RV2, where R is the orthogonal distance between grid intersection points. In the 
same manner of [Rich87], we weight each arc in the search graph by the cost coefficient of the region in which 
its midpoint resides. For our tests, grid resolution corresponds to a 100x100 cell lattice. Relative to test cases 
in [Rich87], our grid is of medium resolution. [Rich87] tested a low resolution (2:1) 64x64 grid and a high 
resolution (1:1) 128x128 grid. Thus, we expect solution quality which is generally comparable to [Rich87]. 


b. Uniform-Discrete-Point Global A* Search 
As noted in Chapter II, grid-based wavefront-propagation solution path-cost is generally 
greater than optimal path-cost by some added percentage due to the “‘stair-step” effect. [Rich87] demonstrated 


that this added percentage can vary randomly with resolution. Besides the apparent random nature of the 


102 


percent-added cost on a solution, the wavefront propagation has other drawbacks. Assuming we know the 
window sequence in which a solution resides, then the "stair-step” effect could be eliminated using single- 
path relaxation (SPR) to straighten the path. However, single-path relaxation only removes grid effects from 
the final solution path. So, path-cost errors resulting from grid bias can cause the systematic wavefront search 
to overlook the true optimal path. While higher grid resolution can improve accuracy, this also lengthens 
execution times. 

To improve solution quality over grid-based wavefront propagation, we have developed our 
own simple algorithm, which we also compare against annealing. Uniform-discrete-point global A* search 
is a generalization of the uniform-discrete-point (UDP) method for approximating the locally optimal path in 
a WS to the whole map. The algorithm bears some resemblance to wavefront propagation but has several 
important advantages. 

The uniform-discrete-point global A* (UDPGA*) search technique is quite simple and 
adapts naturally to the geometry and orientation of the boundary edges in the terrain map. As with wavefront 
propagation grid size, UDPGA* resolution is established a priori in the form of a discrete interval, 5. This 
concept 1s identical to that of the same name discussed in Chapter III Section D.2, so the same time trade-off 
applies. Along each edge of the map, we locate uniformly spaced discrete points where the spacing is bounded 
above by the value of 5. The algorithm proceeds in two phases. The first phase is a fast A* search through the 
dual edge-graph (on midpoints only). This is done in exactly the same manner as the A* search for an initial 
solution in path annealing. The purpose is to obtain an early upper bound on optimal path cost to construct a 
bounding ellipse (again, same manner as path annealing). Once the ellipse has bounded the search space, a 
refined A* search begins on the uniformly 5-spaced points. When the shortest path through these points has 
been found, it is returned with the WS in which it resides. We apply UDP/SPR once to that WS to find its 
locally optimal path. This path is returned as the solution. 

UDPGA* is an approximating algorithm in the same sense as wavefront propagation. It 
solves the weighted-region problem (WRP) by systematically searching a discrete graph of some 
predetermined size. This size is a function of the discrete interval, 5, which sets the resolution of what is 
essentially a visibility graph. However, UDPGA* has several important advantages over wavefront 
propagation. First, it does not simulate movement through regions as uniform incremental ume steps. Instead, 
the algorithm takes complete path segments through regions via the weighted arcs of the search graph. It 
crosses each region in a single step by selecting a path segment connecting a pair of discrete points on 


boundary edges. Second, UDPGA* makes more effective use of the terrain map geometry, because the 
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discrete points lie on boundary edges. Path segments between these points conform to natural arrangements 
of edges and vertices in the map. This tends to reduce the error resulting from strict adherence to grid points. 
Third, UDPGA* actively searches for and can find reentrant path solutions. Finally, UDPGA* makes more 
effective use of the bounding ellipse than wavefront. UDPGA* can obtain an initial solution to compute the 


ellipse quickly and exactly because its search graph is oriented on boundary edges instead of a lattice. 


3. Validation Criteria 

We desire to compare performance in terms of two factors of weighted-region problem solutions: 
total weighted path-length and total execution time. As we indicated earlier in this chapter, test maps were 
generated to study path annealing performance in several cost function environments ranging from smooth to 
hilly. At the same time we wish to vary the size of the problem instance to examine time complexity as a 
function of problem size. We establish a fixed set of 12 points in the Cartesian plane of 100x100 units square, 
and we generate 66 distinctly different problem instances by pairing these 12 points as start and goal. Figures 
5.11 through 5.13 illustrate the placement of these points. The general location of the points is based on our 
desire to ensure a wide variety in size and situauon of problem instances while minimizing the advantage that 
either algorithm might gain from a start or goal point that is close to the border. This is an important advantage 
for both algorithms because it can reduce the search space up to 75%. Large obstacles can also contribute to 
this. In experiments with grid-based wavefront propagation, [Rich87] refers to the exploitation of this 
advantage as the heuristic-selection suategy. A more specific local adjustment of the points was made to 


avoid having a Start or goal point reside within a real obstacle for any of the maps. 
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Figure 5.13 Placement of Start/Goal Points (Map3 through Map7) 
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In order to compare the algorithms we need a consistent measure of the size of a problem instance. 
The straight distance between start and goal is a rough measure, however it does not account for the resolution 
of that area of a map in which the search (path annealing or UDPGA*) is conducted. Both [Mitc90] and 
[Rowe90b] determine problem size as a function of the number of vertices searched. The search performed 
by our algorithms is oriented on the boundary edges. Thus, we estimate problem size as the total number of 
boundary edges reached by the initial A* search through midpoints. We count each edge only once regardless 
of how many times it might be visited during this search. This technique for estimating problem size 
approximates the number of boundary edges inside the initial bounding ellipse, since we have found that 
crude A* search generally expands edges in an area roughly equal to the size of this ellipse. The actual 
bounding ellipse is usually smaller because it clips off portions of longer edges at the limits of the A* search 
expansion. Note that the Euler equations establish a linear upper bound on the number of vertices that can 
exist in a connected planar graph of E edges, if the degree of all vertices 1s three or more [Prep87]. 


Vs2/3E if for all vertices, v., Degree(v.) <3 (Eq 5.10) 
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Wavefront-propagation problem-size would ordinarily be measured as the number of grid cells expanded in 
the search. However, in order to have a common measurement upon which to compare all algorithms, we 
use the number of boundary edges for wavefront as well. 

Execution time for each algorithm is computed as total central processing unit (CPU) ume 
expended from the beginning of initial A* search to the return of the final solution. The time required to 
preprocess the map and create necessary data structures is not included in these umes. We have also excluded 
most of the CPU time required to accumulate and summarize statistical data. Both algorithms are capable of 
the graphical display of outputs. We found that these facilities were extremely useful in debugging. While 
maintenance of these displays expends a significant amount of CPU time, such time is not included in the 
timing statistics. Thus, total CPU time for any given run should be a reasonably reliable indicator of relative 
search time. 

Once we have established a relationship between wavefront propagation and uniform-discrete- 
point global A* (UDPGA*) solution’s quality and timing, we will use UDPGA* search as our gold standard 
and compare solution costs accordingly. To compare the relative goodness of solutions for a given problem 
instance we take the ratio of the total weighted path-costs of the path-annealing solution to the UDPGA* 
solution. Thus, a ratio value of one indicates that both algorithms have achieved similar optimal cost results 
for a given problem instance. A value greater than one favors the UDPGA* technique. However, as results 
show, this ratio sometimes dips below one. This happens more often when the value of 6 (the discrete interval 
defining the upper bound on spacing between edge-points) is not small enough to ensure that UDPGA* can 


find the true optimal solution. 
B. ANALYSIS OF TEST RESULTS 


1. Testing of Grid-Based Wavefront Propagation vs. UDPGA* 


To support the claim that UDPGA* is an effective algorithm for comparing the performance of 
path annealing, and to relate both algorithms to the work of [Rich87], we present results which compare our 
prototypes with an implementation of grid-based wavefront propagation on Map1. Figure 5.14 shows the 
results of our algorithms for wavefront, UDPGA*, and path annealing on two problem instances tested in 
{Rich87]. The UDPGA* solution paths (shown in figure) are identical to those returned by Richbourg’s 
recursive wedge decomposition algorithm. The path annealing solutions are identical to the UDPGA* 
solution paths with the exception of two very short segments in the first problem instance (identified in the 


figure). Our wavefront propagation paths (shown in the figure) are somewhat better than those of [Rich87] 
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(not shown). However, recall that we use a lower resolution than the maximum resolution tested by [Rich87] 
(see bottom of Figure 5.14). Also, recall that the percent-added cost for wavefront solutions will vary 
somewhat randomly with resolution. The large difference in execution times between our wavefront 
algorithm and that of [Rich87] can be attributed to at least two factors. First, each algorithm was executed on 
different machine architectures with different implementations of Prolog. Therefore, timing results can only 
be compared in a relative sense. Second, our wavefront implementation does not use the bounding ellipse, 
whereas the wavefront implementation of [Rich87] uses a precomputed bounding box to reduce the search 
area. This also accounts for some of the execution time differences between our wavefront algorithm and 
UDPGA*. Computation of a bounding ellipse or box requires an initial solution which wavefront cannot 
easily obtain. Nevertheless, even if such a solution were provided at no additional cost, it could not adequately 
compensate for the execution tme disparity. Furthermore, in the more complex maps, the bounding ellipse 


often circumscribes the entire map, and therefore, does not help either algorithm. 
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S, [8,61] - G; [48,89] Cost Time(sec) Resolution 
Wavefront 60.5 2131.5 100x100 
UDPGA* 57.8 28.0 6=3 
Path Annealing 98.0 7.5 

* Wavefront [Rich87] 62.4 119.1 128x128 

* Wedge Decomposition 577 Sig 









S» [90,10] - Go [4,92] Cost Time(sec) Resolution 

Wavefront 131.3 6414.2 100x100 
UDPGA* 124.9 60.8 6=3 
Path Annealing 124.9 24.3 











* Wavefront [Rich87] 134.0 456.0 128x128 
* Wedge Decomposition 124.9 117.0 





* Timing results are from different machine 
architecture and Prolog implementation 





Figure 5.14 Map1: Two Problem Instances Comparing Algorithm Performance 
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To relate execution umes as a function of problem size, we examine the performance of each 
algorithm on a set of distinctly different problem instances generated by start/goal pairings of the points 
shown in Figure 5.11. Only 52 of the 66 possible paired cases are tested. The remaining 12 cases are trivial 
and result in straight-line solutions. In such cases, there is no space to search because the bounding ellipse is 
degenerate, and therefore, it actually is the solution. For the uniform-discrete-point global A* (UDPGA*) 
algorithm we set the value of the discrete interval as 6=3. This results in a UDPGA* resolution which is 
usually more than adequate for finding the globally optimal solution. Also, this value of 5 is consistent with 
that used in testing more complex maps. 

The first three plots in Figure 5.15a are of running time in CPU seconds vs. problem size in terms 
of edges for wavefront propagation (100x100 grid), UDPGA* (at 6=3), and path annealing respectively. The 
last plot in Figure 5.15a is a quadratic least-squares curve fit for points associated with all three algorithms. 
We use a quadratic fit under the assumption that the area visited by wavefront, and thus execution time, 
should grow roughly as the circular area of search state expansion around the start point. Use of a bounding 
ellipse and A* search (as in UDPGA*) will tend to flatten this circular area. However, [Pear84] shows that 
an admissible A* search still expands an O(n? ) number of states. The quadratic curves in Figure 5.15a show 


that execution-time growth rate of wavefront is much greater than both UDPGA* and path annealing. 
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Figure 5.15a Mapl1 CPU Time vs. Problem Size (in Edges) 
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We also compared the timing results of wavefront propagation on the same 52 problem instances as before, 
but at reduced resolution. In this case, we run wavefront propagation on a 50xSO cell lattice. The results are 
summarized in Figure 5.15b. Note that even after halving the resolution, the execution-time growth rate 


remains significantly higher than both UDPGA* and path annealing. 
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Figure 5.15b Map1 Cost Ratio vs. Problem Size (in Edges) 


We examined the relative solution quality of the systematic search algorithms, by dividing the 
solution path-cost of wavefront propagation by that of UDPGA* for the same problem instance (path 
annealing will be compared to UDPGA* later). Thus, a value of 1.0 means that both algorithms obtained 
solutions with identical cost. Figure 5.16 shows cost ratio vs. problem size for the 52 instances. Note that in 
all cases, UDPGA* obtains a solution which is better than wavefront. This is because the "stair-step” effect 
of wavefront solution paths results in the percent-added cost discussed earlier. Suaightening the wavefront 
solution paths would generally result in costs close or identical to UDPGA* as the two instances in Figure 


5.14 tend to indicate. However, more computation will be required to locate boundary edge intersections and 


establish Snell’s-Law crossings. 
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Map 1 Wavefront Resolution: 100x100 
UDPGA* Resolution: 6 = 3 
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Problem Size (Edges) 
Mean SD =©Quart Dev Range 
8.959 8.818 8.812 8.074 


Hinimum Quartile 1 Quartile 2 Quartile 3 
9.927 8.948 8.953 8.971 





Figure 5.16 Mapl Cost Ratio (Wavefront / UDPGA*) vs. Problem Size 


While, our results tend to highlight the disadvantages of wavefront propagation, we emphasize 
that there are some advantages and additional factors to consider. To its advantage, the wavefront algorithm 
is relatively easy to implement. If the terrain map is already in digital form, then it is likely well-suited to a 
wavefront approach. Conversion of digital terrain data into a connected planar map of homogeneous-cost 
polygons can be a very time-consuming task. On the other hand, we have found that lattice generation 
(essentially digitizing) of a weighted-region map is also a time-consuming task, depending upon the 
resolution required to capture an acceptable level of detail. Defense Mapping Agency provides terrain in both 
digital and planametric (points, lines, areas) forms [Digi88]. However, without data compression, digitized 
terrain will generally require more raw storage space than planametric format. Furthermore, many map 
objects which may affect cost per unit distance are not easily coded in digital form. For example, the location 
of a minefield is usually specified by reference coordinates points and boundary lines. 

On the basis of the foregoing results, we can say that the UDPGA* algorithm is generally faster 
and more accurate than wavefront propagation. Therefore, UDPGA* provides better competition for path 
annealing than wavefront. The recursive wedge decomposition algorithm is also faster and more accurate than 
wavefront propagation, though it appears that it is not as time-efficient as UDPGA*. However, wedge 
decomposition is guaranteed to find the globally optimal path, whereas UDPGA* can overlook it depending 


upon the value of 5. Note that wedge decomposition has only been tested on relatively simple maps (such as 
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Map1). To determine time and solution quality relauonships conclusively, wedge decomposition should be 
compared directly to UDPGA* and path annealing on identical machine architectures with identical language 
implementations. Furthermore, problem instances should vary over a much larger range of sizes, geometric 


situations, and cost coefficients. 
2. Testing of Path Annealing vs. UDPGA* 


a. Testing of Small Problem Instances 


Having demonstrated that uniform-discrete-point global A* (UDPGA*) search is faster and 
more accurate than wavefront propagation, henceforth, we now focus our attention on path annealing 
performance using UDPGA*% as our gold standard. 

In the case of Map1, resolution could have been finer (for example, 5=2 or 6=1). However, 
we chose 6=3 to be consistent with our studies of the more complex maps. (Even UDPGA* at 6=3 requires 
over 24 hours of CPU time to solve all 66 cases for the larger maps.) 

The path annealing schedule uses fixed value for r, , and uses the cost of the inital A* 


solution as ae: 


a = cost of initial A* solution 


*T, =10 

~R  =.80 

-L =5 

“f£ =4 
§ 


First we consider a comparison of the goodness of solutions as measured by the ratio of solution costs. In 
Figure 5.17 we plot the ratio of solution costs of path annealing to UDPGA* as a function of the size of a 
problem instance in terms of the number of edges. The inset in this figure indicates some key statistics 
computed over the 52 cases. Note that the maximum difference from the UDPGA* solution was less than 


5%, and that the majority of points lie on the axis (1.e. ata 1:1 ratio). 
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Cost Ratio 
PA / UDPGA* 


Mean SD Quart Dev Range 
1.083 8.889 0.808 8.848 


Minimum Quartile 1 Quartile 2 Quartile 3 
1.888 1.880 1.888 1,888 





Figure 5.17 Mapt Cost Ratio (Path Annealing/UDPGA*) vs. Problem Size 


A major advantage of path annealing is execution time savings. Although we designed path 
annealing to be most efficient for larger problem instances, it does surprisingly well even for relatively small 
instances. Figures 5.18 and 5.19 are plots of central processing unit (CPU) time required as a function of 
problem size for UDPGA* and path annealing. These plots contain the same 52 problem instances compared 
to wavefront propagation earlier. However, by not displaying the wavefront data, we are able to expand the 
CPU ume axis to better show the relationship of path annealing to UDPGA*. Even for these smaller instances 
the plots indicate that path annealing has lower average ume complexity. To partially confirm this, we again 
apply a quadratic least-squares curve fit to each plot. The resultant timing curves are shown in Figure 5.20. 
A generalization about the quality of path annealing vs. UDPGA* cannot be made on the basis of these 


problem instances, since they are relatively small. 
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Figure 5.18 Mapl UDPGA* CPU Time Required vs. Problem Size (Edges) 
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Figure 5.19 Mapl Path Annealing CPU Time Required vs. Problem Size (Edges) 
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Figure 5.20 Map! Quadratic Least-Squares Curve Fit: CPU Time vs. Problem Size 


As a final comparison between path annealing and UDPGA* for Map], we plot the solution 
cost ratio against me ratio for each problem instance in Figure 5.21. This plot provides a rough indication 
of the relative time-cost trade-offs between the algorithms. If we consider the point (1,1) as the origin, then 
the four quadrants define classes which categorize test results as good, bad, or in between. A test run which 
falls in quadrant I (upper-right) indicates bad path annealing performance since both time and cost ratios 
exceed one. On the other hand, a point which occurs in quadrant III (lower-left) indicates good path annealing 
performance. Keep in mind that this performance measure is always relative to UDPGA* which does not 
guarantee optimal solutions either. However, the fact that a large number of test points reside on the me ratio 
axis (i.e. path annealing cost / UDPGA* cost = 1.0) is a reasonably good indication that many true optimal 


paths have been discovered. 
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Figure 5.21 Mapl Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) 


b. Testing of Moderately Complex Problem Instances 

For the remaining tests we use the standard set of start/goal points defined earlier in this 
chapter. Recall that this set generates 66 distinct problem instances. The series of plots introduced in the last 
section will be the common basis for discussion of results. In this section we examine the results on Map2 
which has over twice as many edges and regions as Map]. This map will compare performance of the 
algorithms at a larger, yet intermediate level of complexity. 

In these tests, path annealing solutions are compared to UDPGA* solutions with 6=3 and 
5=6. We used the following annealing schedule: 


° r, = 1.5 x (cost of initial A* solution) 


7, = 1.0 

“R =.90 

eL =15 

eL =11 
s 


Figures 5.22a and 5.22b display cost ratio vs. problem size for comparison of path annealing against 
UDPGA* at 6=3 and 6=6 respectively. Although very slight, there is a difference between plots in the 


general height of the points above the x-axis (where cost ratio = 1). This is reflected by the small difference 


117 


in mean cost ratio between the plots as observed in the inset statistical summaries. We should expect this 
since UDPGA* resolution is relaxed. Note also that the quartiles (in statistical summary insets of Figures 
5.22a and 5.22b) are very small for both point sets, because the majority of the points rest very close to or on 
the x-axis. We attribute tiny deviations to rounding errors accumulated during total path cost computation 


more so than physical deviation from an optimal path. 
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Figure 5.22a Map2 Cost Ratio (Path Annealing /UDPGA*) vs. Problem Size (Edges) 
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Figure 5.22b Map2 Cost Ratio (Path Annealing /UDPGA*) vs. Problem Size (Edges) 
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The difference in means between 5=3 and d=6 is so small that the Figures 5.22a and 5.22b 
do not adequately show how the value of 6 can impact on the solution quality of UDPGA™. To see this effect, 
we executed UDPGA* on the same 66 problem instances in Map2 for 6=12. Figure 5.23 is a plot of the cost 
ratios for solution cost of UDPGA* at 6=12 over cost at d=3. This figure shows that solution quality degrades 


significantly as 5 increases. 
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Figure 5.23.) Map2 UDPGA* Cost Ratio (6=12 / 6=3) vs. Problem Size (in Edges) 


The next set of plots (Figures 5.24 through 5.27) show the effects of varying 5 (resolution) on CPU time. 
Recall that 5 defines the upper bound on the distance between edge-points. As we expect, the time required 
for UDPGA* at 5=6 is less than that required at 5=3. Comparison of the quadratic curve fits (Figure 5.28) 
shows the effect of increasing UDPGA* resolution. The dotted lines indicate that doubling resolution (i.e. 


halving the value of 5) results in a four-fold increase in the execution time requirement. 
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Figure 5.24 Map2 UDPGA* at d=3: CPU Time Required vs. Problem Size (Edges) 
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Figure 5.25  Map2 UDPGA* at d=6: CPU Time Required vs. Problem Size (Edges) 
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Figure 5.26 Map2 UDPGA* at d=12: CPU Time Required vs. Problem Size (Edges) 
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Figure 5.27  Map2 Path Annealing CPU Time Required vs. Problem Size (Edges) 
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Figure 5.28 Map2 Quadratic Least-Squares Curve Fit for CPU Time vs. Prob Size 
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Finally, consider Figures 5.29 and 5.30 which are the cost-ratio vs. time-ratio plots when 6=3 
and 6=6 respectively. For 6=3 more points reside further to the left, which is consistent with the overall 
increased time requirement for UDPGA*. However, the cost ratios change very little between 6=3 and 5=6. 
For path annealing, this cost-ratio stability between UDPGA* resolution changes can be attributed to a high 
rate of success by initial crude A* search in locating the optimal-path-containing window sequence or one 
which is close to it. In the following subsections, we shall examine the results of tests for which the initial 
crude A* search is not quite as successful. This will expose a weakness of path annealing — its dependence 


on good starting solutions. 
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Figure 5.30 Map2 Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) d=6 
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¢. Testing Real Terrain 


In this section we present the results of tests conducted on Map3 and Map4 which model 
actual terrain. These maps have about three times the number of edges and regions as Map1. It is important 
to realize that the cost functions in these maps are relatively smooth because they approximate the cost of 
movement as determined from real elevation and vegetation data. In addition to the large reservoir, there are 
also cost coefficient differences between the maps which account for seasonal changes in trafficability. 
However, we have assumed that regional topology remains unchanged from wet to dry season. We have not 
Superimposed tactical data that might induce drastic cost differentials across boundaries, although the 
elevation data does tend to cause such in a few locations. In these maps we set 6=3 to achieve relatively high 
quality UDPGA* solutions. The path-annealing schedule is adjusted somewhat to account for longer window 
sequences which will result from the complexity in these maps. We have extended the annealing chain length 
and cutoff to 20 and 15 respectively: 


° T,, = 1.5 x (cost of initial A* solution) 


8 T, = 1.0 

©*R =,90 

a )060lU= 2 () 

= )6=CU= 15 
AY 


Figures 5.27 and 5.28 are plots of cost ratio as a function of problem size for runs on Map3 
and Map4 respectively. In both maps path annealing does reasonably well for such complex maps. It 1s 
interesting to note that there does not appear to be any significant decrease in solution quality for path 
annealing as the size of problem instances increases. Furthermore, if we assume for a moment that 5=3 is a 
fine enough resolution to ensure that UDPGA* does not overlook an opumal path, then all but a few of the 
path annealing solutions fall within a 5% margin of error. We attribute this behavior to the success of the 
crude initial A* search which often finds a window sequence in the vicinity of the optimal path. We 
emphasize that the success of path annealing is often dependent on the power of this initial crude systematic 


search. 
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Figure 5.31 Map3 Cost Ratio (Path Annealing/UDPGA*) vs. Problem Size (Edges) 


5B: 
Ie 


Vet 
Cost Ratio 
PA / UDPGA* 


8.9 


8.8 


SD Quart Dev Range 
Gee 8.817 8.682 8.118 


8.6 Quartile 1 Quartile 2 Quartile 3 
1.008 1.688 1.884 





8.9 


Figure 5.32 Map4 Cost Ratio (Path Annealing/UDPGA*) vs. Problem Size (Edges) 


Algorithm timing comparisons on Map3 and Map4 yield similar results. Therefore, in 
Figures 5.33 and 5.34 we present only the plots for Map4. The important difference from what we have 


already viewed is the fact that these time plots provide empirical evidence of average time complexites for 
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very large problem instances (300+ edges) without extrapolation. Another quadratic curve fit (Figure 5.35) 
shows that path annealing timing requirements rise very slowly and are almost linear as a function of the 
problem size. The reason for this behavior is that the annealing algorithm is a random sampling mechanism 
whose annealing schedule predetermines to a large extent its running time. The reason why these timing 
results actually do vary with problem size is that the general length of window sequences determines how 
quickly the locally optimal path can be found. Longer WS’s require somewhat more time. Larger problem 


instances will generally have to optimize longer WS’s. 
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Figure 5.33 Map4 UDPGA* CPU Time Required vs. Problem Size (in Edges) 
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Figure 5.34 Map4 Path Annealing CPU Time Required vs. Problem Size (in Edges) 
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Figure 5.35 Map4 Quadratic Least-Squares Curve Fit: CPU Time vs. Problem Size 


The cost-ratio vs. time-ratio plots in Figures 5.36 and 5.37 (for tests on Map3 and Map4 
respectively) reflect the reduced CPU time requirement of path annealing. The few points which remain to 
the right of the cost-ratio axis (time-ratio = 1) correspond to the smallest problem instances. Also, note that 
almost no path annealing runs significantly improve the optimal cost. As demonstrated in the next section, 
this is usually a good indication that the UDPGA* solutions are optimal. The reason is that when UDPGA* 
overlooks true optimal solutions, some path annealing runs usually discover a few better solutions (even 
optimal) than those retuned by UDPGA*. The result will be a few points which dip below the ume-ratio axis 


(cost-ratio = 1). 
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Figure 5.36 Map3 Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) 
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Figure 5.37  Map4 Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) 


As a final comparison, we present the physical locations of the solution paths returned by the 
algorithms. Figure 5.38 and 5.39 illustrate the test maps with all solution paths drawn between respective 
start/goal points. We provide these pictures merely as a visual demonstration to show that the location and 
shape of annealing solution paths compare favorably with those of UDPGA*. The majority of the solution 
paths are identical. A few solutions have slight physical differences which have little impact on corresponding 


total path-cost. 


127 


Yo fi 
pons ye 


Wi, 


A SA an 


i 


SZSEA 


EAL 


WW 
y 4 . rah ‘ 44 


J ‘y SA 
LEIS LIT. 
TRAN 


Ware 7] 
Rom fi 
efs\N ee, Ae 
be nag 

isn 


EIA 


A 
a yy7A: 


SY 
af aw CN 
| Ee ics 

















A 


Figure 5.39 Map4 Solution Paths Found by Path Annealing 
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d. Testing Maps with Highly-Variable Cost Coefficients 
The next series of tests is designed to determine how well path annealing performs on maps 

with generally hilly cost functions. To some extent, these tests indicate the kind of performance we might 
expect if we were to model extremely complicated tactical situations with a variety of overlapping and 
interacting cost coefficients (as discussed in Chapter 1). Recall that for MapS, Map6, and Map7 we have 
randomly assigned region cost coefficients drawn respectively from the three sets: {1,2,3,4,5,6,7,8,9,10}, 
{1,3,5,7,9}, {1,4,7}. Therefore, we describe the general character of each map as follows: 

¢ Map5 - uniformly choppy; many shallow local minima 

¢ Map6 - choppy but irregular; deeper local minima 

¢ Map7 - high cost peaks and deep valleys; several very deep local minima 
For this set of tests we have again chosen 6=3 for the uniform-discrete-point global A* (UDPGA*) search 
algorithm. We modify the path-annealing schedule to conduct a more thorough local search at each 
temperature by raising the reduction factor R slightly. We also start at a somewhat higher temperature to 
delay the onset of freezing, and hopefully, to enable the annealing algorithm to climb out of deeper local 
minima. The new schedule is as follows: 


° r, = 2.0 x (cost of initial A* solution) 


7 = 1.0 

°K =.92 

=L =20 

eL =15 
AY 


We expect that larger numbers of deeper local minima will severely tax the ability of path annealing 
algorithm to find good solutions. This conjecture is partially confirmed by the cost-ratio vs. problem size 
plots in Figures 5.40 through 5.42. While path-annealing solution quality on MapS is somewhat worse than 
it was for smoother maps, we can see a noticeable trend going to Map6 and Map7 as more points wander 
higher above the x-axis. On the other hand, several points below the x-axis indicate that UDPGA* also has 
difficulty finding true optimal solutions. The fact that more points lie above than below the x-axis is 
reasonable since we consider UDPGA* our gold standard, and because it 1s a systematic search which looks 


everywhere a with finite resolution. 
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Figure 5.40 Map5 Cost Ratio (Path Annealing/UDPGA*) vs. Problem Size (Edges) 
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Figure 5.41 Map6 Cost Ratio (Path Annealing/UDPGA*) vs. Problem Size (Edges) 
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Figure 5.42 Map7 Cost Ratio (Path Annealing/UDPGA*) vs. Problem Size (Edges) 
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Although the solution cost from path annealing is significantly more than UDPGA*, we 
emphasize the following two points. First, as mentioned earlier, simulated annealing in general does not 
perform well on search spaces whose cost functions have many deep local minima. The reason is that such 
deep valleys more easily trap the annealing algorithm, preventing it from sampling other areas of the space. 
Second, in these tests we anneal from a single initial solution. If this solution lies within a deep local 
minimum, then path annealing might not be able to escape. Raising the starting temperature is one way to 
prevent such behavior. However, we believe that this is not the most effective use of time in a simulated- 
annealing approach to route-finding. Limited testing indicates that better performance can be achieved for 
minimal time penalties by using the tunneling approach discussed in Chapter IV. Instead of annealing from 
a single deterministic initial solution, it is more advantageous to begin from several which are physically 
scattered around the map. Our concept of crude (boundary-edge midpoint) A* searches can serially find 
several such paths relatively quickly. However, more efficient methods for doing so in a single sweep should 
be investigated. 

An analysis of the CPU time vs. problem size once again illustrates a significant ume 
advantage for path annealing, even with the annealing schedule modified to search more thoroughly (see 
Figures 5.43 through 5.51). With regard to the UDPGA* algorithm, we can identify an interesting trend in 
the point spread going from smooth cost coefficients to very rough. Consider the UDPGA* timing results 
illustrated in Figures 5.33, 5.43, 5.46, and 5.49, corresponding to Map4 through Map7. We can see more point 
scatter as the cost coefficients become more varied. There is also a general downward movement of all points, 
indicating that the average time complexity of UDPGA* improves with rougher cost functions. We can 
attribute each behavior to an increase in the number of deep local minima, and an indication of bounding 
constraint effectiveness. Recall that both algorithms conduct crude initial A* search for an initial solution. 
The UDPGA* uses this solution only to compute the bounding ellipse which can sometimes prune a large 
amount of search space. If the crude initial A* search locates a deep local minimum then the bounding ellipse 
will be tight. The spreading of points shows that some bounding ellipses are small enough to dramatically 
reduce the work of UDPGA*. Path annealing can also be improved with this bound. However, these 
improvements are reflected more in path-annealing solution optimality and not so much in CPU time 


requirements, which are more sensitive to the annealing schedule. 
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Figure 5.44 MapS Path Annealing CPU Time Required vs. Problem Size (in Edges) 
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Figure 5.45 MapS5 Quadratic Least-Squares Curve Fit: CPU Time vs. Problem Size 
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Figure 5.47 Map6 Path Annealing CPU Time Required vs. Problem Size (in Edges) 
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Figure 5.48 Map6 Quadratic Least-Squares Curve Fit: CPU Time vs. Problem Size 
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Figure 5.50 Map7 Path Annealing CPU Time Required vs. Problem Size (in Edges) 
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Figure 5.51 Map7 Quadratic Least-Squares Curve Fit: CPU Time vs. Problem Size 
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The cost-ratio vs. ume-ratio plots in Figures 5.52 through 5.54 are consistent with the 
foregoing discussions of optimality and ume. We see a general trend in favor of the UDPGA* algorithm as 
the number of deep local minima in the cost function increases (from MapS to Map7). However, note that in 
Figure 5.54 for Map7 there are several very low points. As implied earlier, these indicate that even UDPGA* 
is having trouble finding the true globally optimal path. To fix this problem, one must decrease the value of 
6 to increase resoluuion. However, recall that the CPU time requirement reciprocates as the square. Yet, in 
less ume we may be able to run a path-annealing schedule set for more thorough local search, and we may 


also anneal from multiple starting solutions. 
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Figure 5.52 Map5 Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) 
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Figure 5.53 Map6 Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) 
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Figure 5.54 Map7 Cost Ratio vs. Time Ratio (Path Annealing/UDPGA*) 


e. Testing of a Difficult Problem Instance 


As a final test of path annealing behavior, we have selected one particular problem instance 
for which path annealing appears to overlook the globally optimal path fairly often. This problem instance Is 
on Mapé for start point (15,80) and goal point (80,50). The shortest midpoint path-cost (returned by the initial 
A* search) is 239.5 weighted units, while UDPGA* (at 6=3) indicates that the optimal solution cost is 186.9 
weighted units. Repeated runs have discovered window sequences (WS) with locally optimal path-cost values 
throughout the range {186.9...239.5}. 

We applied path annealing 400 umes on this problem instance. The freezing temperature 7), 
reduction factor (R), annealing chain length (L), and cutoff (LL) values were fixed at 1.0, 0.92, 20, and 15 
respectively. We used eight different starting temperatures, and SO runs were conducted for each starting 
temperature. These results are summarized in Figure 5.55. This plot indicates the percentage of runs (out of 
50) that path annealing returns the optimal path (cost = 186.9) as a function of the starting temperature. The 
chart shows that for this particular problem instance, it is more advantageous to begin annealing from a lower 
starting temperature. The reason for this is that the initial A* search returns a midpoint path which represents 
a high speed corridor containing the global optimum. Higher temperatures allow the annealing process to 
easily wander out of this corridor. Recall that since Map6 is very hilly, many relatively deep cost-function 


valleys exist. Once out of the corridor corresponding to the initial solution, decreasing temperature may 
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prevent annealing from returning to it. In such cases, if annealing did not discover the optimal solution while 


inside this corridor, then it will settle for a non-optimal solution within some other corridor. 


% 
Optimal 
Solutions 
Found 
(in 50) 


Starting 
Temperature 


250 To 





Figure 5.55 Percentage of Optimal Solutions (out of 50) vs. Starting Temperature I, 


This behavior lends support for the tunneling ideas proposed in Chapter IV, Section C.3.c. 
Recall that the basic concept of tunneling is to locate a set of initial window sequences representing different 
high speed corridors, and permit annealing to search each corridor more intensively by starting at lower 
temperature. This method redirects the time necessary to climb out of and move between corridors. Instead, 
this time can be devoted to more thorough searching of high speed corridors which have the most potential 
to contain optimal solutions. For this particular problem instance, Figure 5.56 provides an indication of the 
wide range of solutions on which path annealing can settle. This figure represents a list of all final solutions 
sorted by cost for over 400 runs of the path annealing algorithm on this problem instance. Note that even 
though the starting temperatures vary, path annealing found the globally optimal solution (cost = 186.9) in 


over 33% of these runs, and found better solutions than initial A* (cost = 239.5) in over 75% of the runs. 
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Figure 5.56 Final Path Annealing Solutions Sorted by Cost for Multiple Runs on a 
Particular Problem Instance (Start [15,80], Goal [80,50], Map6) 


138 


VI. CONCLUSIONS 


A. SUMMARY OF SIGNIFICANT RESULTS 


In this dissertation we have proposed a stochastic algorithm, path annealing, to solve the weighted- 
region problem (WRP), in particular, for large complex problem instances. Based primarily upon the 
combinatorial optimization technique known as simulated annealing, path annealing employs systematic and 
local search in coordination to obtain good initial solutions that can improve over time. Since the algorithm 
is a local search of complete solutions, there are more opportunities to establish and update bounds on the 
globally optimal solution. Furthermore, we have designed additional spatial constraints and heuristic 
enhancements to reduce search space and increase the performance of path annealing to an extent that it 
becomes compettive with other approaches to the WRP. We have implemented and tested a prototype of this 
algorithm on maps with over 300 boundary edges and 100 weighted-regions. 

We believe that path annealing is a practical approach to weighted-region path planning in a military 
setting in which region cost coefficients may model many battlefield parameters. In our review of various 
path-planning implementations, we have seen evidence that large problems overwhelm agenda mechanisms 
used by systematic techniques such as A* and uniform cost search. Our approach represents an attempt to 
focus the strengths of both local search and systematic search to solve a relatively difficult problem in a 
reasonable amount of time. 

Our investigation of current algorithm implementations reveals that grid-based wavefront propagation 
appears to be the only one capable of handling the complexity of our test maps. Recall that this al gorithm’s 
uniform cost search and resulting grid-biased solutions hamper both efficiency and solution accuracy. In 
order to provide a faster, more accurate algorithm to compete with path annealing, we designed and 
implemented uniform-discrete-point global A* (UDPGA*) search. It appears that this algorithm may also be 
Significant, since it too is a new approach for solving the weighted-region problem (WRP). It represents a 
wavefront propagation approach which employs an adaptive grid that conforms to the geometry of the 
homogeneous-cost regions, and essentially forms a visibility graph. With the addition of the single-path- 
relaxation technique for finding the locally optimal path in a window sequence, and a few heuristic 


improvements, UDPGA* search often finds an optimal path with very good accuracy. While empirical 
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execution tmes are significantly greater than path annealing, they would quite likely be much lower than 


grid-based wavefront propagation. 
B. ALGORITHM STRENGTHS AND WEAKNESSES 


1. Strengths 

Test results indicate that for non-trivial problem instances path annealing has faster average 
execution times than uniform-discrete-point global A* (UDPGA*) search. Also, the path-annealing time 
advantage appears to increase as problem instances become larger in size. Both algorithms use Snell’s Law 
to optimize within the window sequence determined to contain the optimal path. Therefore, compared to grid- 
base wavefront propagation, path annealing and UDPGA* final solutions can be more accurate, since they 
avoid the digital bias problem associated with an orthogonal grid. Furthermore, for similar resolutions, we 
believe that the solutions found by UDPGA* are likely much closer to true optimal than will be those found 
by wavefront propagation. In this regard, path annealing solutions are also accurate. However, their nearness 
to true optimal can be both much worse and much better than UDPGA*. 

Significant advantages result from the fact that path annealing examines only complete solutions. 
This gives the algorithm the potential to discover and cache many good routes between a given start and goal. 
Furthermore, additional opportunities occur to update the upper bound on the optimal solution cost, which 
controls the size of the bounding ellipse. Solution quality tends to improve over time after the establishment 
of the initial solution. In ume-constrained circumstances, we can abort path annealing prematurely and accept 
the best known solution. This cannot be done with systematic search techniques because they produce a final 
solutions by constructing and comparing many smaller partial solutions. 

Since path annealing is probabilistic, its results are non-deterministic. Multiple runs of the same 
problem instance may return different solutions. Even if two runs return identical solutions, the sequence of 
states processed to reach those solutions are almost never identical. Therefore, every run has the potential to 
discover other good routes between designated start and goal. This behavior can be exploited by parallel 
execution on multiple processors, to which path annealing is easily adapted. Recall from Chapter IV that by 
constraining the A* search in various ways, we can force it to locate several initial solutions corresponding 
to different high-speed corridors. Since each processor begins from a different initial solution, we are able to 
increase efficiency by annealing at lower starting tempcratures, and, at the same time, we broaden coverage 


of the search space. 
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Many spatial constraints and heuristics are available to reduce search space and improve execution 
times. Some of these are annealing-specific, while others are useful for local search techniques which 
examine complete solutions. We have also developed shortcutting analysis and critical-angle analysis. These 


are general spatial constraints which can be used by most other weighted-region problem algorithms. 


2. Weaknesses 

Apparently no practical WRP algorithm can provide an absolute guarantee of finding a globally 
optimal path. However, systematic approaches can effectively upper bound the error if the optimum is 
overlooked. For example, the total cost of an 8-neighbor grid-based wavefront propagation solution can be 
no more than 1.08 of true optimal solution cost. We emphasize that while execution times can be more 
practical, the cost of a path annealing solution is bounded above by a function of the initial A* solution cost. 
This represents a weaker upper bound, since this is restricted to midpoint paths. While improvements can be 
made by increasing the resolution of the initial A* search, tests on UDPGA* indicate that execution times 
will rise quite rapidly. 

To obtain good results from path annealing requires some general knowledge of the topology and 
cost function of the map. Input maps should have reasonably balanced resolution, devoid of boundary edges 
which are unusually long in relation to neighboring edges. Regions should not be extraordinarily narrow. 
Recall that improper window sequences involving the multiple crossing of such edges and regions may not 
be reachable by the simple move generator we have designed. A more elaborate move generator might 
remove this restriction. However, this may also increase the time required to generate the next window 
sequence. 

Path annealing appears to work best on maps with smoother cost functions. This comes as no 
surprise since simulated annealing reportedly performs best in such search spaces [John90Q]. Hilly cost 
functions increase the risk of prematurely freezing the annealing process in a bad local minimum. On the other 
hand, hilly cost environments appear to require higher resolution of the UDPGA* algorithm in order to obtain 
solutions nearer to true optimal. In turn, this results in much longer running times. Though the general 
performance of path annealing in such maps tends to be worse, it can still find a few dramatically better 
solutions in less time. 

Good algorithm performance can be sensitive to the annealing schedule. There are many ways to 
establish good annealing schedules. We have suggested some primitive methods on the basis of current 


annealing and WRP research. But, our testing does not attempt to determine how best to establish annealing 
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schedules. Instead, we used our own judgement based upon experience with the test maps. However, in most 
cases, establishment of an annealing schedule must be done empirically or with some knowledge of the search 
space. 

Finally, even with the combination of simulated annealing, A* search, relaxation, bound 
construction, and heuristic improvements, the path annealing algorithms still only solves a single problem 


instance for a specific start/goal pair. 


3. Strengths of Uniform-Discrete-Point Global A* (UDPGA*) Search 

We have focused on the advantages and disadvantages of path annealing. However, we believe 
that the uniform-discrete-point global A* search algorithm provides fairly stiff competition for path 
annealing. We reemphasize that UDPGA* search has a few advantages of its own over grid-based wavefront 
propagation. Since it employs an adaptive grid similar to a visibility graph, it 1s capable of more accurate 
solutions than orthogonal-grid-based wavefront propagation. Although we have not made direct comparisons, 
we conjecture that UDPGA* would be generally faster than wavefront propagation because it is not uniform- 
cost search, and therefore does not search in simulated time increments. Furthermore, UDPGA* preserves the 
ability to adjust resolution through the establishment of edge-points spaced at a discrete upper bound, 6. 
Finally, unlike wavefront propagation, UDPGA* actively searches and detects reentrant-path-containing 


solutions. 
C. SUGGESTED FUTURE DIRECTIONS 


1. Path Annealing Improvements 


Our primary focus in this work has been to establish that a simulated-annealing approach to the 
weighted-region problem (WRP) is both feasible and practical. In designing a working implementation, we 
took steps to streamline particular aspects of the algorithm, such as cost function evaluation and move 
generation. In doing so, we designed several methods for extracting performance improvements and we have 
suggested several others. However, there are surely other techniques for driving these components which 
might be more efficient or more thorough. In particular, more sophisticated move operators could be 
developed by relying more heavily on efficient random access data structures (such as arrays). Prolog dictated 
our use of list-oriented data structures. 

The Snell’s-Law table lookup could also be improved. Recall from Chapter III that this technique 


reduces ray-tracing to constant-time table interpolation for a single crossing episode, so that an iterative 
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coordinate descent method (single-path relaxation) can find the locally opumal path. The table could be 
extended to compute two or more crossing episodes. This might increase the efficiency of single-path 
relaxation, particularly for longer window sequences. 

The spatial nature of the weighted-region problem suggests that several undiscovered geometric 
heuristics may still exist. In particular, the idea of a bounding ellipse originally suggested by [Rich87] and 
[Pear84] appears to have potential. We have improved the technique and heuristically extended its usefulness 
(e.g. j1*-ellipse). However, there are other interesting possibilities. For example, some form of crude 
bidirectional search might quickly outline a general elliptical but irregular boundary which contains the a 
global optimal path. 

The determination of good annealing-schedule parameter values is another aspect of the algorithm 
which may deserve more attention. However, recall that path annealing employs the power of A* search as 
well as local search. Therefore, we believe that good performance of path annealing may not be as sensitive 
to the annealing schedule as the need to obtain good general coverage of the map. This might be done by 
designing a more elaborate move generator. Another way is to find a good set of initial solutions to use as a 
basis for tunneling at lower annealing temperatures. We have suggested that several crude A* searches could 
be used to find this set. However, some limited or modified algorithm to find the first k shortest paths might 
do this more efficiently [Yen71]. 

If parallel processing is available, then a horizontal asynchronous scheme for path annealing 
would require a set of different starting solutions. Each processor would draw one initial solution out of this 
set from which to begin annealing at a low starting temperature. Such a parallel scheme could proceed with 
very little communication overhead. Annealing can also be parallelized in a vertical sense. Move operator and 
cost function evaluation algorithms could be redesigned for parallel execution. The ideas for local 
asynchronous iterative parallel procedures (LAIPP) first proposed and implemented by [Smit88] and later 


implemented for a transputer by [Garc89] have already laid some of that groundwork. 


2. Extensions to Other Route Planning Applications 
In his work on shortest paths in three-dimensional space, {[Akma87] proposed that Monte Carlo 
algorithms may constitute the only reasonable means of solving intractable path-planning problems 
associated with higher-dimension space. We share his belief that such algorithms are not always appreciated 
by the computer science community. Having demonstrated the feasibility of a stochastic approach to the two- 


dimensional weighted-region problem, a logical extension would be to solve a three-dimensional weighted- 
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volume problem. Analogous to aspects of path annealing, the work of [Lewi88] and [Rowe89] attacks this 
problem. This implementation finds a sequence of volumes using A* search through volume centroids, then 
iteratively improves the path in a manner similar to single-path-relaxation. Follow-on work by [Wren90] 
implements random ray-tracing to improve the A* solution paths. However, neither implementation uses 
stochasuc control. 

In practical three-dimensional route planning it is often necessary to consider vehicular 
constraints. For example, shortest paths for high performance aircraft differ from those of helicopters because 
of turning radius constraints. To account for vehicular direction, extension to a fourth dimensional may be 
necessary. Even without weighted volumes, finding optimal paths through fields of obstacles in such search 
spaces is another problem for which a simulated annealing approach could be valuable. 

Another interesting problem for which annealing might provide significant improvements is one 
of locating minimal energy routes through anisotropic terrain [Ross89]. Ideas in this work have inspired some 
of our own, particularly those pertaining to definiuon and representation of the search space. However, we 
emphasize that the anisotropic modeling of cost regions precludes a simple translation from path annealing. 
In particular, we suspect that a more sophisticated move generation mechanism would be required. 

Although we have said that path annealing integrates and coordinates the operations of several 
techniques to solve for only a single problem instance, the idea of constructing optimal-path maps [Alex90] 
probabilistically remains an interesting question. Particular problem instances have optimal solutions which 
appear to be easily found by path annealing. Given a single goal (start), annealing might be capable of 
constructing a proposed optimal-path map of these easily found solutions. Call these skeleton paths, that is 
suspected (with relatively high probability) optimal paths to several scattered start (goal) locations. The paths 
in the skeleton would be assumed optimal until conditions were detected which indicated otherwise. Such 
conditions might be the discovery of better paths which cross over one or more of the current skeleton paths. 
These conditions would trigger updates to the skeleton. Over time continued annealing would eventually 
confirm or correct the skeleton. The algorithm would gradually fill in gaps between skeleton paths and 
confirm them until the entire map was complete. The process would essentially leam the optimal-path map 


by sampling, assuming, correcting, and confirming. 


D. CONCLUDING REMARKS 


In this dissertation we have designed, implemented, and tested an efficient path-planning algorithm to 


solve the weighted-region problem. This algorithm integrates systematic and local search strategies under 
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stochastic control to obtain solutions which are optimal or near-opumal. We have demonstrated that an 
intelligent, probabilistic approach to the weighted-region problem can obtain faster average execution umes 
in exchange for the marginal risk of a bad solution. We believe that path annealing represents a successful 
endeavor, whose further development and extension to other path-planning problems will be a worthwhile 


effort. 
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APPENDIX A - THEOREMS 


Definitions: 

Planar Straight-Line Graph (PSLG) - a graph which can be embedded in Euclidean E? space without any of 
its edges crossing and whose edges are all straight line segments [Prep88] 

Monotone PSLG - Consider a PSLG which subdivides Euclidean E~ space. A subset of E? is monotone with 
respect to the x-axis if the intersection of each region in the subset with any vertical line results in at 
most one segment. A subdivision of E* is monotone (with respect to the x-axis) if all of its regions are 
monotone [Edel89]. This definition implies that every vertex has degree 2. We relax this definition 
shghtly by allowing a PSLG to be monotone if any onentation of the reference coordinate system 
admits a monotone graph. 

Boundary Edge - finite length line defined by two terminating vertices, separating two homogeneous-cost 
regions in the map. 

Traversable Region or Edge - travel on or within is feasible; cost coefficient [1 < oc 

Non-Traversable Region or Edge - travel on or within is infeasible; cost coefficient p1 = 0; e.g. obstacles and 
edges bounding obstacle regions 

Crossable Edge - boundary edge between two traversable regions; note that obstacle boundary edges are 
traversable but NOT crossable 

Border - the outer limits of a finite map beyond which movement is infeasible and cost coefficient [1 = oc 

Border Edge - asingle unique non-crossable edge; all edges attached to a border vertex also link to the border 
edge; the degree of the border vertex is always > 1. 

Edge Chain - connected sequence of vertices such that all vertices have degree = 2, except the first and last 
which have degree > 0 

Border Vertex - terminates a traversable edge at the border 

Obstacle Vertex - terminates at least one non-traversable edge of an infinite cost region 

Interior Vertex - vertex which is not an obstacle or border vertex 

Closed Region - traversable region; all boundary edges are traversable 


Open Region - traversable region; has at least one non-traversable boundary edge or at least one border vertex 
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Vertex Rotation - move operation defined by shifting window sequence across a neighboring interior vertex, 
thereby rerouting it through a different sequence of edges 

Adjacent Edge-Pair - two edges which bound a common convex region and share a common terminating 
vertex 

Non-Adjacent Edge-Pair - two edges which bound a common convex region but do not share a common 
vertex 

Edge Visibility - edge E ; and E, are visible from one another if and only if for any straight path between 
interior points of E ; and E,, all points on the path belong to the interior of the common region bounded 
by E ; and E.. 

Window Sequence (WS) - any ordered set of boundary edges which a piecewise linear path from the 
designated start must cross to reach the designated goal. 

Proper Window Sequence - window sequence which does not cross through any region more than once. This 
also implies that no edge is crossed more than once. 

Improper Window Sequence - window sequence which crosses through at least one region more than once. 

Reentrant Window Sequence - improper window sequence which contains at least one reentrant path 

Self-Crossing Path - acyclic path; note that by the Optimality Principle, such paths cannot be globally optimal 

Reachable - window sequence WS is reachable from another window sequence WS ] if and only if there exists 
a finite sequence of vertex rotations which transforms WS , 10 WS, 

n-Reachable - WS ; is n-reachable from WS ; if and only if there exists a sequence of n or fewer vertex rotations 
which transforms WS , 10 WS, (We also say that WS ; is an n-neighbor of WS a 

Weighted-Region-Problem Map - a PSLG which satisfies the following constraints: 


e All regions are convex polygons. 

e All edge-pair interior angles are strictly less than 180 degrees. 
¢ All vertices terminate a minimum of 3 boundary edges. 

¢ All traversable edges are connected. 

The following set of theorems are proven for monotone PSLG’s. The set of all WRP maps is a more 
restrictive class of graphs and is a proper subset of the set of all monotone PSLG’s. Therefore, these theorems 
also apply to WRP maps. Without loss of generality, we may assume that the infinite non-traversable border 
region does not exist, and that edges which would otherwise connect to it extend infinitely. This is not a 


problem because locally optimal paths cross such edges at Snell’s Law. Since start and goal are well-defined 
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terminal points for all feasible solution paths, then the optimal crossing points on edges which are infinite rays 


cannot possibly exist at infinity. 


Theorem 3.1: 
Consider the set of all proper window sequences (PWS) which cross a monotone edge chain in a finite 
PSLG. The edges in the chain partition the set of proper window sequences into disjoint subsets. Each subset 


is reachable from the other. 


Proof of Theorem 3.1: 
The proof is trivial since it is always possible to perform successive vertex rotations in either direction over 
the entire length of an edge chain. Therefore, any PWS which can reach one subset can reach all subsets. 


QED. 


Theorem 3.2: 
Given a monotone connected PSLG, it is always possible to remove one monotone edge chain (thereby, 


reducing the number of regions by one) and still preserve monotonicity and connectedness. 


Proof of Theorem 3.2: 

Consider an arbitrary monotone connected PSLG. Since monotonicity implies a well-defined ordering of 
regions with respect to the x-axis, then the bottom-most and top-most regions can always be identified. 
Without loss of generality, we will remove a chain from the boundary of the bottom-most region, R. Starting 
from the left ray, scan right and examine each vertex in sequence which is degree > 2. If no such vertex 
exists, then the graph must consist of a single monotone edge chain separating two regions. Merge the 
regions by removing this entire chain. Otherwise, find the common chain of edges separating R from its 
nearest neighbor above (in the monotonic ordering). This chain must be in one of three classes: 


¢ left ray to nght intermediate vertex 
¢ left intermediate vertex to nght intermediate vertex 
¢ left intermediate vertex to nght ray 


We can always identify the terminal locations of this chain by selecting the first vertex of degree > 2 with an 


incident edge (not part of the boundary of R) that exits the vertex on the side of a vertical axis through the 
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vertex which opposes our scan direction. This vertex and the last vertex of degree > 2 (or the left ray if this 
vertex was the first of degree > 2) are the terminal locations of the chain. Note that the scan may not find a 
right vertex with incident edge opposing the direction of scan. In this case, the right ray becomes the right 
terminal. The procedure cannot disconnect the graph because vertices defining the chain to be removed are 
selected on the basis of incident edges which always have opposing headings with respect to the vertical 
axis. Therefore, the chains to which they are connected must be the same, otherwise the graph was not 
monotonic to begin with. This means that there will always exist a second chain which links left and right 
vertices of the chain to be removed. Therefore, these vertices will still be attached after removal of one 
chain. It follows that the graph remains connected. Furthermore, since we always merge the bottom-most or 


top-most regions, the PSLG remains monotone. QED. 


Theorem 3.3: 
If a finite connected PSLG is monotone, and if start and goal lie in different regions, then all PWS’s are 


reachable from any initial PWS. 


Proof of Theorem 3.3 (by induction on the number of regions): 
(Base case) Consider a monotone connected PSLG with only two traversable regions, where start lies in one 
and goal lies in the other. The theorem holds for this case. To see this observe that for any finite number of 
vertices in the chain of common edges which separates the two regions, all PWS’s are reachable by vertex 
rotations along this common chain. (/nductive hypothesis) Assume that the theorem is true for a finite (n)- 
region PSLG where start and goal lie in different regions. (/nduction) Consider an (n+/)-region map. 
Arbitrarily select one region, R, to merge with either start or goal-containing region, 7. R must satisfy the 
following conditions: 

¢ R does not contain the start or goal. 

¢ R shares at least one edge with T. 

¢ All shared edges form a continuous sequental chain, C. 

¢ Removal of C does not destroy monotonicity. 
Theorem 3.2 guarantees that at least one chain exists which satisfies these conditions. Merge R and T into a 
single region, 7”, by removing the entire edge chain common to K and T. Let the set of edges in this chain be 
C. The resulting map will have n regions. By inductive hypothesis all PWS’s in this (n)-region map are 


reachable from any initial PWS between start and goal. We claim that all PWS’s in the (n+/)-region map are 
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reachable from any initial PWS between start and goal. To see this, first consider the set C. Since C is an 
edge chain, then by Theorem 3.1 any PWS that crosses an edge in C can reach any other PWS that crosses an 
edge in C. (We will say that such a PWS is C-crossing.) Next, consider all ordered pairings of boundary 
edges between R and T (one taken from the R boundary, and one taken from the T boundary) where neither 
is in C. For each such pair, all non-C-crossing PWS’s containing this pair in the (n+/)-region map must be 
reachable by inductive hypothesis. For each such pair, all C-crossing PWS’s containing this pair in the 
(n+1)-region map correspond to the same PWS’s in the (n)-region map where the edge in C has been 
removed. This one-to-one correspondence between (n)-region and (n+/)-region PWS classes means that 
removal of the edge chain C does not change the total number of PWS’s. Since the inductive hypothesis 
guarantees that all PWS’s in the (n)-region map are reachable, then it follows that all PWS’s in the (n+J)- 


region map must also be reachable. QED. 


Definitions: 

G - an arbitrary globally optmal path 

R. - homogeneous cost region 1 

[.. - cost coefficient assigned to region 1 

E;E. - edge-pair consisting of E and E 

ee arbitrary interior point on P. (i.e. not a vertex) 
De arbitrary interior point on P; (1.e. nota vertex) 
& - interior angle formed by an edge-pair 

le na clockwise perimeter bypass path 


P, - counterclockwise perimeter bypass path 


Theorem 4.1: 

In Figure A.1 consider the edge-pair E nie which bounds high-cost region R, whose cost coefficient is H. 
Let fp Pp ) be the function which maps all pairs of interior points P. and P; between edge-pair E pF, to the 
maximum of the two ratios P ja and P./d, where P , and P,, are the weighted costs of the perimeter paths 


clockwise and counterclockwise around R,, from p. to P and d is the unweighted Euclidean distance 
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between points p.and P That is, fle p P = Max(P j/4P./d). Since the length of each edge in E pe , is finite, 
then {Pp Pp must reach some maximum value, H. If 9 > then no optimal path can cross through region 


R, from interior points of edge-pair E pe, 
Proof of Theorem 4.1 (by contradiction): 


Suppose there exists a globally optimal path G which crosses R ; from interior points of edge-pair E pe» and 
that > H.. For simplicity, let = P/d, where P = Max{P),P2}. Then it must be true that > P/d. It 
follows that Hd > P. But this contradicts the Principle of Optimality, that is all subpaths of a globally 
optimal path must be optimal themselves. If Hd > P, then the perimeter path, P, must be shorter than the 
segment which lies on the globally optimal path, G. Therefore, G cannot be a globally optimal. But P/d 
represents the maximum ratio over all crossings of R ; via edge-pair E pes We conclude that no globally 


optimal path can cross R 5 from edge-pair E ; -E > because a shorter perimeter path always exists. QED. 





Figure A.l_ Edge-Pair EE, on Homogeneous-Cost Region R, 
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The significance of Theorem 4.1 is that for a given edge-pair on region R 9° if we can determine L. the 
maximum attainable value of P/d over all interior crossing points, then a simple comparison to LL, tells us if 
the edge-pair can ever be crossed by any globally optimal path, whose start and goal points do not reside 
within R 9° Since L, is the maximum attainable value of P/d over all interior crossing points, then any upper 
bound on this value which is exceeded by Lp» the cost coefficient of R pcan be used to eliminate this edge- 
pair as an optimal path crossing site. 

It is important to note that we need only concern ourselves with analysis of crossings involving a pair 
of interior points on the edge-pair. The reason is that the search space of window sequences is redundant at 
boundary edge vertices. That is, any path or portion thereof, which passes through a map vertex must be 
within two or more distinct window sequences. Thus, eliminating edge-pair E ples from regionR g means that 
the value of Hy is too large to permit an optimal crossing between any interior points of E ye: It does not 
mean that an optimal path cannot cross over E ppl E, by using a vertex of the other. However, doing so 
constitutes use of a neighboring edge-pair. 

The greatest perimeter bypass cost for any edge-pair on any region is bounded above by one half the 
total weighted cost of traveling in a closed-loop around the region following its boundary edges. This cost 
value is easily computed for any region. We will refer to it as P Note that there may exist many pairs of 
points P,P, onan edge-pair for which P = ee =P,.To obtain the tightest upper bound on P/d we must find 
a pair of interior points for which P = P. =P, and d is a minimum. On the basis of geometry, it 1s possible 
to find a subspace of crossings through R, between E pee which maximizes the ratio P/d. Theorem 4.2 


describes how. 


Theorem 4.2: 
Refer to Figure A.2. If the infinite line extensions of an edge-pair E ye bounding region R P intersect at a 
point A at which an interior angle @ is formed, and if 1 < Uy and H, <UL, are the cost coefficients of E ; and 
E, to the outside of R) then for any crossing of E re, from interior points p. to P; the maximum value of P/ 
d occurs when 

sht= (u, + UL, Cosa) / (1, +H, Cosa) (Eq A.1) 


where s is the Euclidean distance from A to P; along E Pr and ¢ is the Euclidean distance from A to P; along E r 


Proof of Theorem 4.2: 


sy 


We obtain Eq A.1 by using Figure A.3. In this figure the edge-pair is adjacent and so a perimeter bypass path 
from p to P; has weighted distance: 
P= s+ Hf (Eq A.2) 


By the Law of Cosines a crossing path from po P; through R, has unweighted Euclidean distance: 
d= Js’+-2stCosa (Eq A.3) 


The ratio P/d is now a function of s and ¢: 
ea Vie 
Bice + re —2stCosa 


Taking the partial derivatives of f(s,t) with respect to s and ¢, setting them equal to zero, and solving for s and 


sf) = (Eq A.4) 


t yields: 

s/t = (pw Pagal Cosa)/(U, +, Cosa) (Eq A.5) 
Since f(s,f) reaches its maximum value when the ratio s/t satisfies Eq A.1, then P/d is also maximum when 
this condition is satisfied. Although we began with an adjacent edge-pair intersecting at common vertex A, 
note that Eq A.1 1s the maximizing condition for any edge-pair whether adjacent or non-adjacent. The reason 
is that only Eq A.2 (cost of the perimeter path) changes if the edge-pair is non-adjacent. In this case, the 
addition of a constant term (fixed cost to travel the perimeter edges between the edge-pair) does not effect 


the result of taking partial derivatives. QED. 


subspace of 





Figure A.2. Non-Adjacent Edge-Pair 
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region Ro 





Figure A.3 Adjacent Edge-Pair 


Theorem 4.2 tells us that with respect to P/d, the maximum advantage for an edge-pair crossing on 
interior points occurs in a subspace of segments between the edges. Figure A.2 illustrates such a subspace. 
The bounds of the subspace are defined by vertices of both edges in the pair. In the case of a parallel edge- 
pair angle a=0. Therefore, Eq A.1 tells us that the maximum advantage occurs at perpendicular crossings. 

We can employ the concepts of Theorems 4.1 and 4.2 to find the value of H for a given non-adjacent 
edge-pair as follows. Using the values of pl» and angle © compute the ratio for s/t by Eq A.1. Using this 
ratio we can determine the two segments which bound the subspace of crossings that maximize P/d. A binary 
search can locate the segment which divides the clockwise and counterclockwise perimeter bypass path-cost 
exactly in half. The value of y= P/d, where d, is the Euclidean distance of the segment at half perimeter. 
If such a segment does not exist within the subspace, then the subspace boundary segment whose perimeter 
paths (clockwise and counterclockwise) have the least difference should be used. Let its smaller perimeter 
path-cost be P Then the value of i= P fd. where d is the Euclidean distance of the segment bounding the 


subspace. 


154 


For adjacent edge-pairs the computation is more straight forward. There is no need to find the bounding 
segments of the subspace because one end is bounded by a vertex. So we can use Eq A.1 to subsutute for s or 
t directly into Eq A.4. This yields the following equation for adjacent edge-pairs: 

Ju? + [15 - 21, 1,Cosa 


= LS), ae (Eq A.6) 


Having computed L for the edge-pair in question, we can now compare to }1,, the cost coefficient between 
the edges. If Hy > L, then the weight in region R ; is tOO great to permit an optimal path to cross on interior 


points of the edge-pair. 
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APPENDIX B - PROLOG AND C SOURCE CODE 


B.1 PATH ANNEALING 


ms sc es sc ss ee es es es ie iw 
SS ee ee ee me ee we we = 


Annealing schedule notes: 


A schedule is defined in terms of the initial A* solution cost. 
The predicate annealing schedule(TC,TF,TR,NT,NS) defines the parameters 
to be used in the call to init anneal(TS,TF,TR,NT,NS) . 


TS starting temperature in units of cost 

TC cost multiplier, ensures high temp (TS=TC*init soln _ cost) 
TR temp reduction factor (geometric schedule) (T2 <- TR*T1) 
NT n_limit, total number ATTEMPTED moves at temperature T 
NS ns_limit, total number ACCEPTED moves at temperature T 


Cl NN 


:- dynamic 
finished/0O, 
annealing schedule/5, % annealing schedule(TC,TF,TR,NT,NS) . 
starttemp/1, 
current/3, 
next/l, 
best/4, 
newbest/4, 
ultimate best/4, 
bestacounty 1% 
hash _ws/4, 
hat s/ 14 
hthresh/1, 
deltak/1, 
time/1. 


annealing schedule (ies) 170707 9,20, 15) % default schedule 
hthresh(10). % default 
hashwtn{ (ob), 8): = surmise (hye % sum of E 
sumiist (2170). > 4. 


sumlist((X|L],SUM) :- sumlist(L,S), SUM is X+S, !. 
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prep :- 

compute deltak, 

w_initparms, 

retractall (finished), 
retractall(starttemp( )), 
eeeractall (current ( 727.) ), 
retractall(next(_)), 
metractall({best(_, , _4_)), 
retractall(newbest(, , ,_)), 
recractali(ultimate best( ,_, 
Betractal (best. count (.)), 
retractall(hash ws( , ;,_7..))+ 
retractall(hits( )), 
asserta{best count (0)), 
asserta(hits(0)), 

w_wsinit, 

Banainit( ), 


Gesce Points, 


eompute deltak = 
retractall(deltak( )), 
Stabe (S,SK), 
goal(G,GR), 
rv(SR,SW, _), 
rv(GR,GW, _), 

ela (Di), 

DK is 0.5*DI* (SW+GW), 


asserta(deltak(DK)), 
t 


install best (COST, WS, PATH) 
retract (best count (N)), 
Mis N+l, 
doselbed (best count (M)'); 
asserta (best (N,COST,WS,PATH)), 


= 


Prep, 

es, 

search(WSO,_), 

iy kot ra (Wo, Done, .)), 

solve (WS0,DSEED, SEED, COST), 
avg_path_wt (COST, SEED, APW), 
asserta (optimal cost (APW)), 
write list({’Average Weight 
ellipse (COST), 

install best (COST,WS0, SEED), 


anneal 


= 


S time, da, st, deltak 


epee) cr 


> remove epts from last run 


% A* thru midpoints 
% approximate w/UDP 


% refine w/SPR 


$ heuristic ellipse 


,APW)]), 


2 


+ bounding ellipse 


low 


asserta (Current (COST, ASU; SEED), 
hash fn (WSO,H), 


asserta (hash_ws(H,WS0,SEED,COST)), 


updates (COST,WS0O), 


annealing schedule (TC, TF, TR,NT,NS), 


TSTART se TC*CoOsn, 
asserta (starttemp (ISTART)), 
init anneal(TSTART;/ IF 1k, N1,Ns)y, 


anneal _ loop, 


anna Pl OOb ms. = 

repeat, 

CUTLENE(GL, Wolk); 
perturb ws(WS1,WS2), 
perturb ws (WSA,WS2), 
asserta(next (WS2)), 
hash tn(Wo27ayy 
compute cost (H,WS2,PA2,C2), 
metrop(Cl,C2Z,41). 

(I=] =5 writelnd{c2) 7 
action(1,C2Z,WSZ, PAZ), 


oP 


fo)\e) 


oP 


% Let race (exe. 
finished, 

ha Gera ver. 
hats (kK), 


hthreshn(T), 

Hit omsoqhnL)y, 
retrace (nites (2) ); 
asserta(hits(0)), 
' 


hit - rate. — 


hit. msq(K7 1) 2— 
Ig 22 ak 


% hash fn for ws 
% insert in hash table 


6 set annealing parms 
$ search by annealing 


% for larger moves 
% for debugging only 


% observation tool only 


° 


% for debugging only 


writeln(’Rising cache hit rate...return to a previous best’), 


bestwecunt (N); 


g=AeiMeag ice) EUs epat=astalioisle) jesrsic (Nh) § 
! 


return to a previous best (1) §s— 1epilace current() 


reLurmee Osa previous bese (nN) s.— 
igeand (N; Xx); 


wep lace veurrenuts), 
t 


replace Curremegn), <— 
Betmact Current (ju, ))), 
best (X, (GF W, P) f 
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asserta(current(C,W,P)), 
{ 


Aetion(X,C2,WS2,PA2Z) :- 


( X =:= 0 -> fail 
eee tee ACCept (C2, WS2, PAZ), hat. rate 
,; X =:= -1 -> frozen(C2,WS2,PA2) ), 


e s 


accept (C2,WS2,PA2) :- 
metract (current ( ,97_)), 
asserta (current (C2,WS2,PA2)), 
eompare to best (C2Z,WS2, PAZ), 


frozen(C2,WS2,PA2) :- 
compare to best (C2,WS2,PA2), 
asserta (best (C2,WS2,PA2)), * cheek vicinity for optimal 
update_clock(Tl), 
write list([{’iterative improvement begins time’,T1]), 
iter improve, 
ultimate best (N,C,WS, PATH), 
update clock(T2), 
gle 
w_ showdata(pacost,C), 
w_showpath (PATH), 
WEate list ({" finish time =’,T2)), 
Heee list (tN, Optimal Cost =",€)), 
weite Jist({’ WS =',WS)), 
write list(({’Path =’,PATH]), 
ml, 
w_clear ws, % reqd by ws display routines 
asserta(finished), | 
notrace. 


feeteimprove :- 
best (_,_+_vs_), 
Bepeat, 
get_top_best(N,C,WS, PA), 
perturb ws(WS,WSO), 
hash_fn(WSO,H), 
compute_cost (H,WS0,PA0,C0O), 
iter impr(C,C0,X), 


( X =:= 0 -> fail 

; X =:= 1 -> retract(best(N, , _,_)), % from top of stack 
asserta (best (N,C0,WS0,PA0O)), 
fail 

; X =:= -1 -> retract (best (NN,CC,WW,PP)), 


asserta (newbest (NN,CC,WW,PP)), 
iter improve ), 
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iter improve :- 


retract (newbest (N,C,WS,PA)), 


asserta(ultimate_ best (N,C,WS,PA)), 


retrieve best, 
t 


get_top_best (N,C, WS, PA) 


retrieve best :- 
retract (newbest (N0,C0,WSO0,PAO0)), 


ultimate best (N,C,WS,PA), 


:- best (N,C,WS,PA), 


( CO=<C -> retract (ultimate best (N,C,WS,PA)), 
asserta (ultimate best (N0O,C0, WSO, PAO) ) 


retrieve best, 


retrieve best :==s!. 


compute cest (H7Wsa2,7PA, ec). — 
hash_ws(H,WS2,PA,C), 
score(hit), 
t 
GOMpULeTeOsE lH, Ws, 6 Cm = 
dijkstra(WS2,PA2,C2), 
best (_,C0,_,_), 


refine (WS2,PA2,C2,C0,PA,C), 
asserta (hash_ws(H,WS2,PA,C)), 


score (cache), 


refine (WS2,PA2,C2,C0,PA,C) :- 
deltak (DK), 
C2=CO0 < DK; 
solve (WS2,PA2,PA,C), 


EFeLAInNe (pr AZ, ec, Pac, Clee 


score (X) 


retract (hits(I)), 


( 


oa 
c 


X==hit -> J is I+l 
X==cache -> J is I-1 ), 


asserta(hits(J)), 


compare to best (C2,WS2,PA2) :- 
best (_,C0O,_,_), 


(C2 < €0Q —> anstall best(C2 ,WS27e aoe 


e 
’ 


! e 


updates (C2, WS2) 


otherwise -> updates (null, WS2) 
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dy 


), 


% hash £oree¢ese 
% Walt 


$ must compute cost 


° 


%$ approx w/UDP 


% cache 


% refine w/SPR 


% not worth the trouble 


% install best so far 


meaactes(C,WS) :- 
update clock(T), 


w show ws(WS), $ display new WS2 
( C==null -> true 
meGenerwise —> besti(N, ,..,PA),; % must be new best 


w_ showpath (PA), 

w_Showdata (pacost,C), 

write list({T,sec,N,’New best cost =’,C]}) ), 
time_expired, 
In, 


time expired :- 
time (T), 
ae 2000.0, 
w_clear ws, 
writeln(’Time expired: 2000 sec...execution terminates.’), 
best (N,C,WS, PATH), %$ best to date 
Perece list (i, Optimal. Cost =',€]), 
write list({’ WS =',WS)), 
write list([{’Path =’,PATH]}), 
asserta (finished), 


time expired :- !. 
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ASTAR.PL - A* SEARCH 
adapted from Rowe, N.C., "Artificial Intelligence Through Prolog," 
Prentice Hall, 1968, pp. 244-247- 


For an application, define 5 predicates: 


(a) successor (State, Newstate) (gives state transitions) 
(b) goalreached (State) (defines when goal achieved) 
(c) eval(State, Evaluation) (estimates cost to the goal) 
(d) cost (Statelist, Cost) (computes cost of a path) 


(e) top-level predicate that initializes things if needed, 
then calls astarsearch with two arguments, the starting 
State and variable which will be the solution path 


Note that "cost" must be nonnegative. The “eval" should be a lower 
bound on cost in order for the first answer found to be guaranteed 
optimal, but the right answer will be reached eventually otherwise. 


These routines are used to quickly obtain a good initial solution 
for annealing. The search is to find the shortest weighted path 
through the edge dual graph (midpoints of boundary edges only). 


At conclusion of processing: 
no. of items in agenda - 1 = no. of unexamined states 
no. of items in usedstate = no. examined states 


Modifications to oraginal) code: 


In this version, cost is changed to cost (Statelist, O0ldCost,NewCost) 
to reduce the work required to compute the cost of a new statelist. 
Also, we have replaced pick_best_path rules with a more efficient 
version which uses Quintus Prolog hashing on the first atomic 
argument. The agenda_index is a sorted list of indices into agenda. 
Sorting is accomplished by insertion (since large heaps are not 
efficient in prelog): 


The original code referenced in [Rowe88, pp. 244-247] states that if 
the evaluation function is ALWAYS a lower bound on the cost function, 
then faster performance results if we delete the first rule of 
agenda_check and usedstate check, and the entire definitions of 

fix agenda and replace front. We have determined that the first 

rule of agenda check IS REQUIRED to guarantee optimality in a 
general graph (ie. NOT a tree). Therefore, we have NOT excluded it. 
Since our evaluation function is Euclidean distance to the goal at 
lowest cost on the map, then it is a lower bound on cost. 

We have, therefore, modified the original code accordingly. 
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:- dynamic 
max e/l, 
agendacount/1, 
agenda_index/1, 
usedstate/2, 
agenda/5. 


successor, goalreached, eval, and cost functions CANNOT have cuts ! 


Pimeecoson(E0,E1) := { ep({E0,E1l,_,_,_) ¢ ep{El,E0, , _,_) ). 
goalreached(g). 


eval(E0,EVAL) :-% direct Euclidean dist to goal at lowest cost 
goal(GP,_), 
edge data(E0, ,MP), 
Serimal cost (OC), 
wdistance (MP,GP,OC,EVAL) . 


eose(([s],_,0.0). 

eose ([F0,E1|L),O0LDCOST,COST) :- 
Wep(E0,E1,7,-7 C) ; ep(et, £0,770) dy 
Ges 1s OLDCOST+tC. 


Seaten(WS,Cost) :- 
mmknown ( ,fail), %$ required by astarsearch 
writeln(’Begin A* search for initial WS...'), 
astarsearch(s,WS,Cost), 
write list([’Initial WS =',WS]), 
weaote last([*Cost thru midpoints =',Cost)), 
Haknown( ,trace), % reset after astarsearch 
w clear iter, % DISPLAY 
t 


een) :- Writeln b(’ERROR (astar)...A* search failed !'), !. 


astarsearch(Start,Goalpathlist,C) :- 
cleandatabase, 
add _ state(Start,[],0.0), 
repeatifagenda, 
pick_best_state(I,State,Pathlist,C,D), 
add_ successors (I,State,Pathlist,C), 
agenda (I,State,Goalpathlist,C,_), % soln on top of agenda 


w_show_ws(Goalpathlist), % DISPLAY 
t 


pick best state(I,State,Pathlist,C,D) :- 
agenda incgex([{1,_ J) lJ), 
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agenda (I, State, Pathlist,¢ )) 
t 


add successors( ,State,Pathlist, } :- goalreached (State), !. 
add successors( ,State,Pathlist,C) :- 

successor (State,Newstate), 

add_ state (Newstate,Pathlist,C), 

fail. 
add successors (1, State, Pathiist,c 

retract agenda (I,State,Pathlist,C,D), 

asserta (usedstate(State,C)), 

faa 


add_state (Newstate,Pathlist,C) :- 


cost ({Newstate|Pathlist],C,Cnew), 


t 
OZ 


agenda _ check (Newstate, Cnew), 


! 
7 


usedstate_ check (Newstate, Pathlist,Cnew), 


t 
aid 


eval (Newstate,Enew), 
D is Enew + Cnew, 
assert agenda (Newstate, [Newstate|Pathlist],Cnew,D), 
update clock(T), 
max eval (Enew), 
display newstate (Newstate,Pathlist), % DISPLAY newstate 
tm, 
Io 
add state (Newstate,Pathlist,C) :- 
not (cost ({Newstate|Pathlist],C,_)), 
write list b{[ 
‘ERROR (asStar)...cost fn failure’, [Newstate|Pathlist]]), 
t 
add state (Newstate,Patnlise) =. — 
not (eval (Newstate, Enew)), 
write list b({ 
‘ERROR (aStar)...eval fn failure’, [Newstate|Pathlist]]), 
t 


display newstate(E0, [El|_]) :- %$ DISPLAY 
edge_data(E0, ,MP0O), 
edge data (hi a MEL), 
w show _line(MP0,MP1,2), 
t 


display newstate(, 11) i=... % for start state 


agenda, Cheek (S) ©): — 
agenda(1I,S, ,€2,_), 
C<CZ, 
ret ractenagendd (1,5,.5, ya) 
t 


s ¢ 
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femeaecheckK (5, ) :— agendat ,o, , , ), ', fail. 
egenda check( , ). 


Peecasceatem=eneck (5, ,.)™:— usedstate(S, ), !, fail: 
Bsecastatemeneck{ , ,_)™ 


repeatifagenda. 

repeatifagenda :- agenda( , , ,_,_), repeatifagenda. 

cleandatabase :- 
retractall (agenda _index( )), 
asserta(agenda_index([])), 
retractall(agendacount(_)), 
asserta (agendacount (0)), 
retractall(agenda(_, _,_,_,_)), 
retractall(usedstate(_,_)), 
retractall(max_e(_)), 
asserta(max_e(0)). 


Mesert agenda(State,Pathlist,C,D) :- 
get _index(I), 
asserta(agenda(I,State,Pathlist,C,D)), 
retract (agenda_index(L1l)), 
insert _index([I,D],L1,1L2), 


asserta (agenda _index(L2)), 
t 


imsert index(ID,[(),[ID]). 
Mrisertsrndex({I,D],[[10,D0)|LJ,[[1,D],[10,D0)|L)) :- D =< DO. 
tices: index(ID, [ID0|L1), [ID0|L2)) :- insert _index(ID,L1,L2). 


delete index(I,[{],[(]) :- write list _b({’ERROR...delete index’,I]). 
delete index(I,[[{I,_J|L]),L). 
delete index(I, [ID|L1], [ID|IL2]) :- delete _index(I,L1,L2). 


retract agenda(I,State,Pathlist,C,D) :- 
retract (agenda (I,State,Pathlist,C,D)), 
retract (agenda _index(Ll)), 
delete index(I,L1l,L2), 


asserta (agenda index(L2)), 
t 


Set index(I) :- 
retract (agendacount (N)), 
lose Nt L, 


asserta(agendacount (I)), 
t 
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ELLIPSE.PL - intersect all edges with bounding ellipse computed from 
weighted length (D) of best path found to date; update edge data 


:- dynamic 
ecost/l1, 
optimal cost/1. 


Optimal Tecost (la) % default optimal cost coefficient 


ellipse(D) :- 
asserta (ecose (D)), 
w_showdata(elcost,D), 
get optimal cost (OW), 
write list([’optimal cost =’,OW]), 
Stace (5, .)7 
goal(G,_), 
edge (E, [V1,V2],_,_+_), 
total dist(S,G,V1,OW,D1), 
total dist (S,G, V2, On sea 
intersect ellipse(E,D, OW,S,G,V1,D1i7 72722), 
Fai) pth 
ellipse(_) :— writeln{”’ Computed bounding ellipse. >) = 


get. optimal cost;(OW). >;—“opeimal=cose (On), a % ONLY the top cost 


total dist(S,G,V0,OW,DT) :- 
wdistance(S,V0,OW,DS), 
wdistance(G,V0,OW,DG), 


DT is DS+DG, 


intersect ellipse ())D,.,57.) 2, > lee): = % both vertices inside 
D1 =< D, $ V1 inside 
D2 =< D, %$ V2 inside 
t 

intersect ellipse (E,D,OW,S,G, V1, D1, V2, DZ) wae $ edge crosses once 
Die D, % V1 inside 
DZ. 4D, % V2 outside 
elsearch(D,OW,S,G,V1,V2,D2,NV2, LEN), 
update db(E,V1,NV2,LEN), 
asserta (ovr (NV2,0)), 
retractal Wiveiv2,.)), 
Ww point (NV2, 4), 
t 
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mabensect ellipse(E,D,OW,S,G,V1,D1,V2,D2) :- % edge crosses once 
Die D- % V1 outside 
D2e— 4D. % V2 inside 
elsearch (D,OW,S,G,V2,V1,D1,NV1, LEN), 
update db(E,NV1,V2,LEN), 
asserta(ovr(NVv1,0)), 
Beevactali(ve({vi,.)), 
w_ point (NV1,4), 
t 


miearsect Cllipse(E,D,OW,S,G,V1,D1,V2,D2) :- % edge crosses twice 
vtan_inside(E,D,S,G,VTAN), 
elsearch (D, OW,S,G, VIAN, V1,D1,NV1,LEN1), 
elsearch (D, OW,S,G,VTAN, V2,D2,NV2, LENZ), 
LEN is LEN1 + LEN2, 
update db(E,NV1,NV2, LEN), 
asserta(ovr(NVl1,0)), 
asserta(ovr(NV2,0)), 
Betractall(ve(Vvi, )), 
Betractall(ve(VvZ,_)), 
w point (NV1,4), 
w_point (NV2,4), 


Mmimeersect Cllipse(E, ,; 4+ 7 + 4 4.) ?7 % edge outside ellipse 


remove from dab(E), 


Weaneanside(E,D,S,G,VTAN) :- 
edge (E, [V1,V2],_,L,_), 
vtangent (E,L,S,G,VTAN), $ virtual tangent point 
between(V1,VTAN,V2), % must be between Vl and V2 
get optimal cost (W), 
Boral dast (S,G, VIAN,W,DVT), 


DVT =< D, $ vtan is inside ellipse 


Meanaqent (E,L,S,G,VTAN) :- 
perpendicular(S,L,PS), 
perpendicular (G,L,PG), 


distance(S,PS,DPS), 6 perpendicular from s 
distance (G,PG,DPG), $ perpendicular from g 
PART is DPS/DPG, % CAUTION no denominator zero check! 
partition (PART, [PS,PG]),VTAN), % by similar triangles 


Update dbd(E,V1,V2,LEN) :- 
retract (edge (E,VOLD,W,L,H)), 
asserta(edge(E, [V1,V2],W,1L,H)), 
retract (edge data(E, ,_)), 
midpoint (V1,V2,MP), 
assert (edge data(E,LEN,MP)), 
obstacle adjust (E,VOLD,W), 
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obstacle adjust (FE, [V1,_],[.,0])) :- ovr(V1,0), 1.3 alreacyeaan- 
ebstacle adjust (EF, (V1, 2), ole 

OvE(y IR) 

re(R,_,ELST), 

merge with ellipse bound (ELST), 


ebStac levad just (yates 


merge with ellipse_bound([{]) :- !. 
merge with ellipse bound([E/ELST]) :- 
adjust_ovr(E), 
merge with ellipse bound (ELST), 
t 


aajust [ovr (E) es] 
edge (E, (V1, V2] a a ’ 


retractall (6ovr(Vi, 9)), 
retractall(ovr(V2, _)), 
asserta(ovr(V1,0)), % region 0 considered outside ellipse 


asserta(ovr(V2,0)), 
] 


adjust_ovr(_) :- !.% in case edge has already been removed 


remove (i uemlOe (Em... 
retract (edge(E, (Vi, V2)7.,., ) )5 
retractal ll (edgevdatant lh ea,) 


retractall(er(E, ,_)), 
Eetractaliep( Eis, ene) ie 
netractalit(en( 7 Ey a7 720) 9 
retractall(ve(Vvl,_)), 
retractall(ve(vZ,_)), 


retracta li( Pink (Eye i), 


retracta ll (iamk( eye 7 2), 
t 
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SPR.PL - solve for local optimal path through ws by relaxation; 
relaxation requires Snell’s Law Table loaded by optimal.pl 


——waynamic 
iter limit/1l, % iteration limit (prevents infinite looping) 
stable/0, % stability indicator (switch) 
st/ 1. % stability tolerance 
Seu.1). 
see to ee oe ee 
NOTE: solve guarantees ws and path are ordered consistently in parallel 
eR edge ee ee ee ee Le x / 
solve (WSO, [PO|PLST],OPLST,COST) :- 
ensure parallel (P0,WS0,WS), 
make wtlst(WS,WL), % create WL - weight list 
compute iter limit, 
ipass (WS, WL, [PO|PLST],OPLST), %$ iterate thru WS until stable 
which direction(OPLST,WS,WL,TWL), % orient TWL = either WL or RWL 
compute cost (OPLST, TWL,COST), % solution cost (path length) 


metractall(iter limit ( )), 
! 


. * 


compute iter limit :- 
Gap), 
st (ST), 
Peas DI/ST, 
eeiling (fF, 11), 


asserta(iter limit (IL)), 
! 


ensure parallel(P0,[sIiIWSg],[s|WSg]) :- start(P0O,_), !. 
ensure parallel(P0,[gIWSs],[gIWSs]) :- goal(P0O,_), !. 
ensure parallel(_,WS,RWS) :- rev(WS,RWS), !. 


make wtlst([s|WS], [SWIWT]) :- 
Seat edi, SR), 
rv(SR,SW, ), 
make wtlst2(WS,WT,SW), 
' 

make wtlst([g!WS], [GW|WT]) :- 
goal(_,GR), 
rv(GR,GW, ), 


make wtlst2(WS,WT,GW), 
t 
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MmakeswelstZ2(l 17 1), eee % start or goal (end of list) 
make wtlst2([E1,E2|WS], (W1|WT],W0O) :- 

edge (Ea W,_,_) ’ 

next_wt (E1,W0,W,W1,E2), %$ rule contained in udp.pl 


make_wtlst2([E2|WS],WT,W1), 
' 


ipass ((E0 |WS],WL, [PO|PLSTO];OFLs1))-= % first pass, do net iskiam. 
w_ show_iter([P0O|PLSTO],1), 
assert (stable), 
passZ (WS, WL, (P0|PLSTO],PLST2), 
Pass chk (0, (E0( WS), WL, (S02 lotZ |, Obbcr), % change direction 


w Clear iter, 
' 


pass (I, (E0,E1|WS), (WO{WL), [P0,P1]PLSTO),OPLST) :- 
Wo oilOwW 1ter (BO, Pile bololr, a), 
assert (Stable), 
pass2 (WS, WL, [P1|PLST0O),PLST2), 
pass _chk(I, [E0,E1|WS), [WO|WL)], {P0,P1|PLST2)],OPLST), 
! 


NOTE: pass2 ensures proper reflection; no stability check is made 
by this rule since reflections are exact per critical angle 


pass2 GlelAi alke EO Le Ol) =. 
pass2([(El,E1,E2|WS], [W1,W2|WL], [P0,P1,P2,P3|PLST], [NEWP1, NEWP2|PLST2]) :- 
Wl > W2, 
reflect (P0,E1,PR1,PR2), 
reflect (P3,E1,PR3,PR4), 
ClOSeSG pale (ei, PR2,Er oe eRe, TPA, Tee) 
refl crossover (P0, TPA, P3, TPB, TTPA, TTPB); 
vertex check (E1,TTPA, TTPB,NEWP1,NEWP2), 
pass2([(E2|WS],WL, [P2,P3|PLST],PLST2), 
! 
pass2((E1,E1,E2|WS), [W1,W2|WL], [P0,_,_,P3|PLST], [P0,PO|PLST2]) :- 
pass2 ([E2|WS),WL, [P0,P3|PLST]),PLST2), %$ ignore reentrant 
t 


pass2((E1|WS), (WO,W1|WL], [P0,P1,P2{|PLST], [NEWP1|PLST2]) oe % CROSSING 
optimal (P0,P2, [W0,W1),E1,NEWP1), 
stable cheek (F0, Pi, 22, NEWEL), 


pass2 (WS, [W1|WL], [P1,P2|PLST], PLST2), 
t 


pass chk(I,WS,WL,PLST,OPLST) :- 
not (retract (stable)), % if NOT stable, 


iter limit (IL), 
5 ee ee eb % and < iteration linge 
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Bev UPLST, RPLST); % then reverse PLST, 
rev (WS, RWS), 
rev (WL, RWL), 
was fT + 1, 


pass (J,RWS, RWL, RPLST, OPLST), % and continue w/ RWS 
t 

paso eenk( ,_,_,OPLST,OPLST) :- % else stable, return OPLST 
wesnOw 1LteEr(OPLST, 2), % highlight stable solution 
t 

Perea rection@p~rd|OPLST), [s|WSq],WL,WL) :- start(PO, ), !. 

Pech direction(([PO0|OPLST], {g|WSs],WL,WL) :- goal(P0,_), !. 

which direction(_,_,WL,RWL) :- rev(WL,RWL), !. % reverse wt list 


eemeace cost({ ],[],0.0) :- !. 

eompuce cost ([P0,P1|OPLST], (WO|WL],TCOST) :- 
wdistance (P0,F1,W0,C0), 
esempucre Gose ((P1JOPLST)] ,WL,COST), 
TCOST is COST+CO, 


= 


fo) 0) 


fete LOssover(PO,PA,P3,PB,MP,MP) :- if reflection crossover 
sqr_dist(P0,PA,SDA), 

sqr_dist(P0,PB,SDB), 

SDA > SDB, 

midpoint (PA,PB,MP), 

t 


feeemeerOossover( ,PA,_,PB,PA,PB) :- !. 


meee ecneck(NPl, ,_,NP1) :- !. 
meaelercneck( , ,NP1,NP1) :- !. 
maeaole check( ,Pl1l, ,NP1) :- 
not (stabilized(P1l,NP1)), 
retract (stable), 
t 
Sseable check( ,_,_,_) :- }. 
Stabilized ([(X0,Y0], [X1,Y1]) :- 
Dx as X1l=-X0, 
DY is Y1-Y0O, 
absolute (DX,AX), 
absolute (DY,AY), 
st (TOL), 
UF % DO NOT try another stability tolerance 
BX Ss TOL, 
AY < TOL. 
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Vertex cCneck(s, TEA, IPB, 2A e oe 
edge (E, [vi Ze r_r_r_) ’ 
v_chk (V1,V2, TPA, PA), 

v ehk(Vi,V2Z, TPB, PB), 
! 


Vv Chk (Vil, V2, 12, 2P) == veetween( Vig mie, V2) eae 
V Chk(Vi,V2,7TP,V1) s= "between (Te, V1l,V2)5. 2. 
V Chk (V1,V2,7P,V2Z) := between(Vi,72,1P),. |. 


reflect - computes reflection points, critical angles, etc. 


xlioadt’ Ii by Gea) 
xload ( lib/ laine’) 


reflect (FP,ER,PR1,PR2) :- 
edge (ER, VR, [W1,W2],LR,_), 
Crit rangle (Wi, w2,1ie), 
ray line angle(se UR, icy rd ne 2), 
endpt_check(P1,VR,PR1), 


endpt_ check (P2,VR,PR2Z), 
! 


Critlangle (wil, W2, Chin — 
Wl =< w2, 
R is W1/Ww2, 
asin(R,CRIT), 
' 

Crit vangletWway We oe ee 
R is W2/Wl, 
asin(R,CRIT), 


relative_angle(L,L,GAMMA) :- 
fzero (GAMMA), 
writeln(’WARNING (spr)...coincident edges.’), 
t 
relative_angle([Al,Bl,_], [A2,B2, _],GAMMA) :- 
Ml is -Al/Bl, M2 is -A2/B2, 
DEN 1S 20+ MiIEAM2, 
NUM is M1-M2, 


rel_ang2 (NUM, DEN, GAMMA), 
! 
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meee ange {(NUM,DEN,+1.57080) =:- 
fzero(DEN), 
NUM>=0.0, 
' 
Pommeange (NUM,DEN, -1.57080) :- 
fzero(DEN), 
NUM< 0.0, 
‘ 
rel _ang2 (NUM, DEN,GAMMA) :- 
TN is NUM/DEN, 


atan (TN, GAMMA), 
t 


fjzerea(O.0) :- !. 

fzero(X) :- 
fabs (X, AX), 
AX < 0.0001, 


ray line angle - computes left,right intersections P1,P2 for a ray 
from fixed point X0,Y0O at angle TH from normal to line [A,B,C] 


NN year ee ye eee ee ee ee ee eee x / 
Beverine angle( ,_,TH, -, _) :- %$ TH = pi/2 
DIF is TH-1.57080, 
fzero(DIF), 
writeln(’WARNING (Spr)...no intersect, parallel ray.’), 
t 
Baeeine angle(P,L,TH,1I1,11) :- % TH = 0.0 


fzero(TH), 
perpendicular(P,L,I1), 
t 


Beene angle ({X0,Y0O], [A,B,C], TH, [X1,Y1], {X2,Y2]) :- 

ees, 12 57080—TH, $ convert to angle from normal 

tan(THI, TAN), 

LO is A*X0 + B*Y0 - C, 

DEN is (A*A + B*B) *TAN, 

EO is A*Y0O - B*xX0O, 

El is TAN/DEN, 

Be 1s L0/DEN, 

Ris (C*A - B*EQ)*El, 

S is (C*B + A*EQ) *El, 

T is A*E2, 

eso *h2, 

X1 ais R + U, 

Vibes) S.=. 7; 
X2 is R - U, 
Yo 2s-S +. T, 
1 
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Cclosest_pair - determines which pair of points on reflection edge 
are true points of reflection (they must be the closest pair). 


closest _pair([(X1l, Yl], [X2,Y2], [X3, Y3], [X4, Y4], [X1, Y11)7 [xXe, 19) a 
DXI is X3-X2, DXO is X4-Xl1, 
fabs (DX1I,AXI), fabs (DXO,AXO), 
AXI > 0.0005, AXO > 0.0005, 
return_pair (AXI, AXO, 
[X1, Yl], [X2, Y2], [X3, YS], (44,44), [X17 1) 1X0 eee 
t 
closest pair([X1, Y1], [X2, Y21, [X3, voll, [X4, v4), (X1p. 11, (XO, vo lvmmere 
DYI is Y3-Y2, DYO is Y4-yYl, 
fabs (DYI,AY1), tabs (DYO, AYO), 
AYI > 0.0005, AYO > 0.0005, 
return _pair(AYI, AYO, 


(X1,Y1], (X2,¥2], [X3,Y3], [X4,¥4], (XI, YI], (XO, YO]), 
u 


return pair(AI,A0O, [X1,Y1],_, _,[X4,Y4], (X1,Y1), [X4,Y4]) := Al >= AG 
return pair( 7, ->) [X2, YZ) %35, 3) Xa, YS, XS ee 
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OPTIMAL.PL - compute Snell’s Law optimal crossing point by either 
table lookup or golden search (selected by C routine snell) 


pload ( 1ib/ ut. 1? ); 
xload(’lib/line’), 
xload('lib/foreign’). % also loads Snell’s Law Table 
Seetmal ((X1,;,Y¥1),(X2,Y2],_,_,0OP) :- 
DX is X2-X1, fabs (DX,AX), AX < 0.001, 
Wests aY2=Y1, fabs (DY AY) ~°AY -<°0.001, 
meaachooaunit.( [| Xia) } (KX 2) Y2)> OP), 
t 
optimal (P1,P2,WW,E,OP) :- % WW are weights from weight list 
edge (E,V,W,L,_), $ W are weights from edge 
line (P1,P2,LP), 
intersection(LP,L,ITMP), $ straight-line intersection 
optimal2(P1,P2,WW, (V,W,L],ITMP,OP), 
t 
Beeamal2 (P1,P2,WW,(V,_, _],coincide,OP) :- % parallel ==> P1-P2=E 
coincident _ intersection (P1,P2,WW,1I0), 
endpt_check(I0,V,OP), 
t 
Seemmat2({ , ,(W0,WO)],(V,_, ],10,0P) :- % phantom edge IO=OP, unless 
endpt check(I0,V,OP), $ outside edge vertices 
t 
SpeimalZ2 (P1,P2,WW, (V,W,L},1I0,OP) :- $ else, setup table lookup 
match regions (WW,W,P1,P2,PW1,PW2), $ PW* consistent with W 


perpendicular (PW2,L,I2), 
optimal3 (PW1,PW2,V,W,L,1I0,1I2,OP), 


GG6ancident intersection(P1,P2, (W1,W2],P2) :- Wl < W2, !. 
Zmemmetdent intersection (P1,P2, (W1,W2],P1) :- W2 < Wi, !. 
eermeident antersection(P1,P2, (WO,W0],OP) :- midpoint (P1,P2,0P), !. 


eeeimals{ , ,V, » ,10,i2,0P) :- 
vertex crossing(V,1I0,1I2,0P), 
! 

optimal3 (PW1,PW2,V,W,L,1I0,I12,0P) :- 
perpendicular (PW1,L,11), 
snell(PW1,PW2,W,1I1,10,12,0OP0), 


endpt check (OP0,V,OP), 
! 
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vertex crossing ([(V1,V2],10,12,V1) 
between(1I0,V1,V2), 
between (1I2,V1,V2), 
! 

vertex Crossing([V1, V2], 00,127.72) 
between (V1,V2,10), 


between (V1,V2,I12), 
t 


match regions (W,W,P1,P2,P1,P2)- 
match _regions(_,_,P1,P2,P2,P1). 


% 


ensure point between vertices 


endpt eheck (1, (V1, V2), V2)". — between(/ i277 
endpt_check(I, (V1,V2],V1) :- between(I,V1,V2), !. 


endpt check(I,;[ 2,7. J; 1)" -=2e 
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UDP.PL - approximates locally optimal path through a WS using 
Dijkstra’s Algorithm through a constrained graph of discrete 
points evenly distributed on each edge with upper bound di; 
used for coarse approximations, and aS a preprocessor to 
the more accurate single-path relaxation (SPR) algorithm. 


-= dynamic 
“ola ly aa % di(i).current discrete interval = i 
epts/3, % epts(e0,di, [pl,..,pn]). edge-points on e0 
pe/2. $pe(e0, [[vlj si, oll ;..,vn, sn, pnt) 


% edge-point record e0 
:- use_module(library(lists), [rev/2]). 


eaeGe8) . % default discrete interval 


cegiestra({ , _],(SP,GP],COST) :- $ trivial soln s-g 
Stare (SP,SR), 
re(SR,SW, _), 
goal(GP, _), 
wdistance(SP,GP,SW,COST), 
' 
eeacstra((E0,51|L),PATH,COST) :- % ws begins EO = s;g 
Start goal(E0,P0,W0), 
edge (a W,_7_) ’ 
di(INT), 
Soest INT, Pisl), 
process routes (W0,[((P0,0,0]],PTS1,PTLST1), 
asserta(pe(E1,PTLST1)), 
next wt (_, WO,W, WN, _) ’ 


t 
7 


dijkstra2([El|L],WN, PATH, COST), 
w clear iter, 


—_ —— oe oe eee eee ee ee oe ee ee eee ee ee es ee ee i ie es ee ee es i i i ie ie ee ee ee ee ee ee ee eee eee ee ee ee ee ee ee ee eee ee ee ee ee eee ae ee a 


seegkeotraZ([El,E0), _,(PO|PATH),D) :- % ws end EO = s;g 
betel, Fe uLSl i) 
Start _goal(E0,P0,WO0), 
process routes (W0,PTLST1, [P0], [{P0,D,BG]]), 
back pointer (P0,[[P0,D,BG]],BP), 
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w_ show _line(P0,BP, 4), 
retrieve min _path(BP, PATH), 
{ 
dijkstra2((El1,E2,E3/L]),W1,PATH,D) :- % mid ws 
pe(El-PrEsTing 
edge (EZ pa Wye _) ’ 
GGiN Ti 
epts(E2,INT,PTS2), 
process routes(W], Piisiteiszc, 2 esi, 
asserta(pe(E2,PTLST2)), 
next _wt (E2,W1,W,WN,E3), 
t 


tf 


dijkstra2([E2,E3|L],WN,PATH,D), 
' 


Gajkstraz (Ws, W, ee) ec $ catastrophic failure 
current (_,WS07 2); 
retract (next (WS1)), 
writeln(’WS ERROR (udp)...dijkstra2 failed !’), 
write list([‘’weight: ’,W]), 
Write: Jisti(| Gpaerital se wole, 
Write. list ([ ecurerent:. 3 Well). 
write Jist (| next 2 sili, 


writeln(’Corrective action...continuing from current WSO72a oe 
MPiege ar, tak) aS 

Start goal(s,P,W) :— startle, 2) re(R, a) 

start goal(g,P,W) :> gCai(h Rijs Le (hs, eee 


back pointer (Ee st(l pis, 22 ies .Se ecm 


back pointer(P,[_|b),BP) := back pointer(?, ir. 
retrieve min path(SP, (Sel) := start(oe, = 
retrieve MinwpatniGe, 1 Ge jel: —-ngoa (Chm yee 


retrieve min path(P, [P|PATH]) :- 
retract (pet, Pitot ey, 
back pointer (P,PTLST,BP), 
w show _line(P,BP, 4), 
retrieve min_path(BP, PATH), 


process routes - establishes all routes between an edge-pair; 
Wl = weight of the region separating the edges 
PTLST1 = list of point records [V,S,P] for the "from" edge 
PTS2 = list of points on the "to" edge 
PTLST2 = new list of point-records [V,S,P] for the "to" edge 
min route finds shortest accumulated distance S and the pointer 
P back to the appropriate "from" edge point-record labeled V. 
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Precess routes( , r,ljJ-(])} :- '- 
Peaeeess routes (W1,PTLST1, [ViL), ([(V,S,P)|PTLST2Z]) :- 
mom route (Wl, PiLstT1,V,. yo, 2]), 


i vocess routes (Wl, PILSTI., PILSsT2), 
t 


next_wt(_,W0, [WO,W2),W2, ) :- !. 

next_wt(_,W0, (W1,W0],W1, _) :- !. 

next _wt (EC, ,chk,WN,EA) :- % EC choke vertex ==> look ahead at EA 
ChetEe, VC, ), 
er(EA,RR,_), 


next _wt2(RR,VC,WN), 
t 


next wt2((R1,_J],VC,WN) :- rv(R1,WN,VLST), member(VC,VLST), !. 
next wt2Z([{_,R2],VC,WN) :- rv(R2,WN,VLST), member(VC,VLST), !. 
IIE ere ea a a ae oe eo ae ee = a eS SSS =S-== 


mameroute - updates the point record [D,P]) for point V by computing 
weighted distance from each point in list L (points on the last 
edge in the window sequence) and returning the min total weighted 
distance D and the point P from which it was measured to V. 


cee ne a an <P mo es oe x / 
foomerouce( ,([), ,(D,P],[D,P]) :- !. 
feomeecuce (W, ([[V,D, ]1/L),V0,(D0,P0)], ([DF,PF]) :- 
wdistance(V,V0,W,DV), 
w_ show_line(V0,V,1), 
Diets Db + DV, 
update point ((D0, PO], [DT,V], (D1,P1]), 
min route (We iG VO Dene) Dr. PE, 
t 
eee point (([D, ],(DT,V],(DT,V]) :- ( var(D) ; DT<D ), !. 
Beewwee POint (([D,P), ,{D,P]) :- !. 
eC i a == === 
get pts - uses a fixed interval (di) to space points uniformly across 
each edge; this interval is an upper bound on the point spacing, 
ie. spacings on some edges may be < di (never greater than). 
an a a vera ae ee le ee ee ee oe ae eee emeee * / 
Spies (h,1,PLST) :- gen epts(E,1I,PLST), !. $ non-exist ==> generate pe 


Semsepcts({B,INT,PLST) :- 
edge(E,V,_,_+_), 
get pts(E,V,PLST), 


asserta(epts (E,INT,PLST)), 
t 
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resetepoints. -— % for subsequent program runs 
retractall(edge pt(_,_)), 
retractall(epts (3) er 


asserta(( epts(E, 1,PEsT)ee] Genvepts (et bot) 
t 
Getsptsii v0, 701700) eee % choke vertex 
get pts (E,[V1,V2], [NVijL1) 3 — % fixed interval size INT 
edge _data(E,LENG,_), 
LENG > 0.0, % in case V1,V2 too close 
ai(INT), 
R_INTS is LENG/INT, 
ceil(R_INTS,INTS), % di(INT) LUB on dist to next point 
PART 125 020017 INTs, $ pull in slightly from vertex 
partition (PART, [V1,V2],NV1l), 
% w point (NV1,3), %$ show point spacing/coverage 


divisions GiInts-Vinvz, hb), 
{ 


get pts (71 Vie ee ee % V1,V2 too close for preevsnen 


divisions (INTS,V1,V2, [NV2]) :- 


INTS =< 1, 
PART: is 7029997 INTS; $ pull in slightly from vertex 
Pareition (PART, (Vl,v2i7 12), 

% w point (NV2,3), % show point spacing/coverage 


! 
divisions (INTS, V1, V2, (201) — 
PART is 1/INTS, 
Partition (PART [vie 2) Pole 
w point (P0,3), % show point spacing/coverage 
NX_INTS is INTS-1, 


divisions (NX_INTS,P0,V2,L), 
t 


ove 


al ivepts. =— % generate all edge-points 
edge (E,V, [_, W),_,_) ’ 
w =\= 0, 
get pts(E,V,L), 
fail, 
tes 
all epee := {© 


180 


PERTURB.PL - move generator; generates random WS transitions 
(vertex/obstacle rotation and reentrant installation) 


ee 
:- dynamic 
single jump/0, % flag to set single rotation 
lock path _class/0. % flag to lock between obstacles 
PaO he Sa Ne eR Ofek 8 Ct ee ae 
Beeeurd ws((S,G],WSl) :- % [s,g] or [g,s] ==> same region 
repeat, %$ until [S,G] changes 
SeveCest ype (2 1eh), 
Special sg _ move (TYPE, [S,G],WS1), 
t 
perturb ws(WS0,WS3) :- 
length (WS0, LEN), 6 compute range 
RANGE is 2*LEN-5, 
repeat, %$ until move from WSO is found 
select _edge_ which (RANGE, EDGE, WHICH), 
Spamen0 (BDGE,WS0,50,C1, C2), * NTH edge is EO between Cl1,C2 
Sclectmeype (YEE), 
sub selections (TYPE, WHICH, EO, [C1,C2,LOC], ITEM), 
take _ action (TYPE, ITEM, LOC, WS0,WS1), 
eyele chk (WS1,WS2), 
fix ws (WS2,WS3), % strip out dumb turn edges 
% ws integrity (WS0,WS,WS1,WS1), % for debugging only 
{ 
Betece type(TYPE) :- 
teand(2,X), 
( X=:=0 -> TYPE=0 % reentrant 
; otherwise -> TYPE=1 ), $ vertex cross 
{ 
Beectal sg _ move (0, (S,G],[S,E0,E0,G}]) :- % special reentrant 
Start(_,RO), 
re(RO,W0,ELST), 
select (ELST,EO), 
not (edge (E0,_,[_,0],_,_)), * no border or obstacle edge 
t 
Peeetalesg move (i,(S,G],WS1) :- % special vertex cross 


Sikaet( , RO), 
rv(RO,_,VLST), 
select (VLST,V0), 
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border(BRD), 

not (ovr(V0,BRD)), $ cannot jump a border vertex 
ve (VG VELST) ’ 

re (RO, _,RELST), 

set intersect (RELST, VEEST, 55), 

split _ee (EE, VELST, [S,G],WS1), 

t 


set intersect ( ()7 a4 
set intersect ([AIB],C,D) :- 


memberchk(A,C), 


t 
oo 


D=[Al|E], 
set intersect (B,C, E) . 
set_intersect ([AIB],C,D) :- set_intersect (B,C,D) . 
split e¢e((E1,E2Z),VELST, [S,G]|,NEWSEQ) <- % shift E1,E2 to ends Cf#WvrEpan 


shift list (El, VELST, (El, E | Domes 

( E==E2 -> append([(E|LST], (E1],SUB) 

; SUB=([B1, Esti); 

irand(2,X), 

( X=:=0 -> append([(s|SUB), ([g]),NEWSEQ) $ insert SUB between s,g 
*; X=:=1 -> append([g|ISUB],[s],NEWSEQ) ), 


— a oe oe oe owe ee em ae a a = a Se Se ee Se ee ee ee ee Se ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee a a ae ae ee a es es i i iii ie ee ee ee ee ee a 


select edge which (RANGE, EDGE, WHICH) :- 
irand(RANGE,J), 


I 1S 2, % NOT at s or g 
EDGE is -1//2, $ pick edge 
WHICH 1S LL moda2, % 1lf/rt vertex or fwd/bck region 
t 

SuUbsSelecei1ons (0, When n0 eu, e2, bee lah) % reentrant move 
( WHICH=:=0 -> er(E0, (RO, _],_) % which region 
; WHICH=:=1 -> er(E0,[(_,RO],_) ), 


re (RU; abbot), 
( memberchk(C1,ELST) -> LOC=[C1,E0] 


; memberchk(C2Z2,ELST) -> LOC=[E0,C2] ), %$ failure ==> s org 
Subtract (ELST, LOC, RELST), % remove EO and C* 
select (RELST,ER), % select ER from region elist 
t 

Sub select i1ons(07 a, 20, Oe % failed reentrant ==> verge. 


irand(2,WHICH), 
Supe selectwvons (1, WHECH, E0,., V0), 
! 

sulp_ Stl eet ions (1,WHiCH, £0,727 VO). — 6 vertex move 
( WHICH=:=0 -> edge(E0,[V0,_],_,_,_) $ select V1 or V2 
¢ WHICH=:= 1) —> edge (EC ame 0 1. e eee, 
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select (L, ITEM) :- % select random ITEM from list L 
length (L, LEN), 
irand (LEN, xX), 
nthO (X,L, ITEM), 
ie % do NOT select again 


Pemicenu(Nl, [A,B,C|WS),E0,C1,C2) :- 
( Nl=:=1 -> EOQ=B, C1=A, C2=C 
; NO is Nil-l1, 
SPrnenoiNe, [B,C (WS ],b0,C1,C2) ), 


tareraction(0,ER,LOC,WSO,WS1) :- $ reentrant 
possible reentrant (ER, LOC,WS0O), % legit reetrant path ? 
reentrant_install(ER, LOC,WS0,WS1), 
t 

make action(1,V0,_,WSO,WS1) :- % single vertex rotation 
Single jump, % flag for single jumps 
get_elst(V0,ELST), 
move _ws(WS0O,ELST,WS1, ), 
t 

Pakenaction(1,V0, _,WSO0O,WS1) :- % double vertex rotation 
get_elst(V0,ELST), 
move_ws(WS0,ELST,WSA,E), 


second _move(E,V0,WSA,WS1), 
t 


second move(null, ,WS,WS) :- !. 

second_move(E,V0,WSA,WS1) :- 
new_vertex(E,V0,V1), 
get_elst(V1,ELST2), 


move _wS(WSA,ELST2,WS1,_), 
' 


new _vertex(E,V0,V1) :- edge(E,[V0O,V1l],_,_,_), !. 
new_vertex(E,V0,V1) :- edge(E, [V1,V0],_,_,_), !. 


possible reentrant (ER, [E1,E2],WS0) :- 


( ep(E1,ER,_,W0,_) ; ep(ER,E1l,_,W0,_) ), % exists ? 
( ep (EZ, ER, ,W0O,_) ¢ ep(ER,E2,_,W0,_) ), 
not (consec_reentrants([(E1l,E1,E2],WS0)), % consecutive reentrants 


not (consec_reentrants ([E1,E2,E2],WS0)), 
t 
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eEonsec  neentrants ( [A,B,C lyale, aye, lito) |) 
consec _ reentrants (SUBLST, [A,B,C|LIST]) ;- 


Consec  reentrants (SUBBSi, (2, Clic), 
t 


reentrant install {ER, [B1,B2], [E1, B2|WS0], [E1,ER, BR, E2|WS0]) 2 
reentrant install (ER, LOC, [E3,E4!WS0], [E3,E4|WS1]) :- 
reentrant _install(ER, LOC, [E4|WS0], [E4|WS1]), 


get _elst(vV0,ELST) :- 


ovr (VO0O,R), + if obstacle vertex 
t 

7 

not (lock pathwelass), % NO lock on path subclass 
not (border(R)), % NO border jumps 
nNoetevr (V0, 0), % NO ellipse bound jumps 
( chr(E,VO,_), che (E, ELST) % choke vertex 
; oe(R,ELST) ), * regular obstacle vertex 
t 

get _elst(V0,ELST) :- ve(V0,ELST), !.% else non-obstacle vertex 


= 


move _ws(WS0,ELST,WS1,E) :- 
slice (WS0, ELST,WF,S1,S2,WB), % extract critical edges 
make_new_seq(ELST,S1,S2,NEWSEQ), % S1=[EF,E1,R1] S2=[EB,E2,R2] 
append (WF, NEWSEQ, TEMP), 
append (TEMP,WB,WS1), 
( NEWSEQ = [E] 
| NEWSEQ = [] -> E = null 


| otherwise -> select (NEWSEQ,E) ), 
{ 


slice (WSO, ELST, WE,S1,S2,"8) -:— 


extract (WS0O,ELST,WEF,S1), % from front Glew 
rev (WS0,RWS0O), 
extract (RWS0, ELST, RWB,S2), %$ from back of WSO 


rev (RWB, WB), 
i 


extract ({[A,B,B|IWS],ELST, [A], [A,B,1]) :- memberchk(B,ELST), !.% reentrant 
extract ((A,B |WS],ELST, [A], [A,B,0]) :- memberchk(B,ELST), !. % crossing 
extract ([A, BIWS], ELST, [A|WF], [EF, B1,R]) :— 


extract ( [Bis], ELST,WE fee, el, kip 
' 


make néw seq(Ebsl, (Er, El, ), (BB, r2,. |, choles O41 fess omen 
shitt list (El, ELS?, | |OLSTiIE 
Spire list (Oust, bl, 82, Ul noae 
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perder last (EE,EB,/E1L,E2,i1, u2, SUB), 


back list (EB, E2,SUB, SEQ), 
t 


eerste ( , ,[),[]) := *. 
Paew list (EB,E2, SUB,NEWSEQO) :- 
last (FB, SUB), 
( continuous (FB,EB) -> NEWSEQ=SUB 


mec Oss COntinuous (FB, EZ, EB) = append (SUB, [EZ], NEWSEO) =), 
t 


meeeral Conditions( ,_,E,E,_) :- !, fail. 
Seeeradl conditions (EF,EB, ,_,F) :- 
continuous (EF,EB), 
not (continuous (EF,F)), 


not (continuous(EB,F)), 
t 


Meee list (EF,EB,E1,E2,(],(Fl_],1[]) == 
Special conditions (EF,EB,E1,E2,F), 
{ 

@ecer list (EF,EB,E1,E2,(F|_J,[]),[]) :- 
Speeial conditions (EF, EB, E1,E2,F), 
t 

eecer jist (EF,EB,E1,E2,L1,L2,SUB) :- 
frrst elt (L1,F1), 
Morst Glt(L2,F2), 
( continuous (EF,F1) -> SUB=L1 
; continuous(EF,F2) -> SUB=L2 
; continuous(E1,F1) -> SUB=[E1|L1] 
7; continuous(E1,F2) -> SUB=[E1|L2] 
prev (Gl,RL1), 

rev(L2,RL2), 
order list (EF,EB,E1,E2,RL1,RL2,SUB) ), 

t 

@egere list (EF,EB,E1,EZ,L1,L2,_) :- 
writeln b(’ERROR...(perturb) order_list failed !'), 
welvein b((EF,EB,E1,EZ,L1,L2)), 
abort. 


ftiest Elt ({}],null). 
Mest elt ((F|_),F). 


See last (OLST, E1,E1,OLST, ROLST) on % 1f El==E2 (single) 
mev(Olol, ROLST) , 
( 

aoe list {OLST, ,E2,L1,L2) :- break_list(OLST,E2,L1,L2) ,™ 
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break list ({E/GLST), EZ, 517 te 
( E==E2 -> L1l=[], L2=OLST 


; LI=(BE|LL)) -breakelvst (Choi a2, LL) 
' 


continuous (El,E2) :- ( ep(El,E2, 970,.) > epi EZ, ee 


CrOSS COntinuocus (Bt ,EZ,E se % crossing 
(ep(E1l,E2,R1,_,_) + ep(EZ,ElyRly ,_)),; 
(ep( EZ, Bs, RS, 7,2) , je AIS) pe | 5 
not (same(R1,R3)), 


eycle chk (WSt, WsZ) 
eyeclenecleamm@s lh) Woc):, 

arandi(2Z,; x). 

( X=:;=0 —> all cycle clear(Wsl,ws2) 


; otherwise -> cycle clear(WS1,WSZ) ), 
t 


of ol? 


oe? 


cyclevelear(Vis i, WSZ) teas 
triple(WS1,T), 
save front (T,WS1,FRONT, BACK), 
rev (BACK, RBACK), 
save front (T, RBACK,RRBACK, ), 
rev (RRBACK, BAK), 
close gapir Roni, BAK, 1, Ws2), 
i 


cycle clear{Wol, Wst) cn. 


tetp le (ial ee) ee oe 
triple([AjJL],A) :- double(L,A), !. 
triple([A|]L]),B) :- triple(L,B), !. 
double ([2)72) 6. tere 

double ([{A|[L],A) :- memberchk(A,L), !. 
double ( (Ail) By: — doublets), e's 


Save frone (lil (Woll, (iy oe ee ee 
save front (T, [E|WS1], [EJWS2],WSB) :- save front(T,WS1,WS2Z,WSe) 7a 


close gap({PRONT, [EL EAKI 1, WS2) == 
last (E0,FRONT), 


( cross_continuous(E0,T,E1) -> append (FRONT, [T, E1| BAK], WS2) 
; Otherwise -> append(FRONT, [E1|BAK],WS2) ), 


= 


186 


mime yele clear(WS,WS1) :- *’ removes ALE cyclesmexcepe reentrants 
Piicdmeitst dup (Ws, &), 
remove_cycle(E,WS,WS1), 
t 


elec ycle clear(WS,WS) :- !. 


mrncerarst Gup((),_) :- fail. 

Brigdetirst Gup([A,A|B],C) :- not (member(A,B)), find first _dup(B,C), !. 
find first dup((AIB),A) :- member(A,B), !. 

@eerarst dup((A|B),C) :- find first_dup(B,C), !. 


memowercyele( ,[],(]) :- ¢. 


remove _cycle(E, [EIWST], [E|WS1]) :- remove _cycle2(E,WST,WS1), !. 

remove cycle(E, (E1|WSTJ, ([E1|WS1]) :- remove_cycle(E,WST,WS1), !. 

memove cycle2( ,{),{)) :- !. + pinen. off cycle 
Remove cycle2(E,(E)WST), (EIWST)]) :- !. 

memove cycle2{(E, [EWST],WS1) :- remove _cycleZ2{E,WST,WS1), !. 

% me oOoOo ee a Sa SS Se eS SS ee ee 
wS integrity (WS0,WSC,WS1, [(El,E]) :- continuous(E,E1), !. % end ws 
ws integrity (WS0,WSC,WS1, [E1,E2,E2,E3|WS)]) :- $ reentrant 


(ep (E1,E2,R,_,_) ¢ ep(E2,E1,R,_,_)), 
(6p (EZ, E3, R,_,_) ; ep(E3, EZ, ee) Ne 
ws integrity (WSO, WSC,WS1, [E2,E3|WS]), 
t 
ws integrity (WS0,WSC,WS1, [E1,E2,E3{WS]) :- $ crossing 
cross continuous (E1,E2,E3), 
ws_ integrity (WS0,WSC,WS1, [E2,E3{WS]), 
t 
ws integrity (WS0,WSC,WS1, (El,E2,E3|_]) :- 
write list([’ERROR (perturb) ...Invalid WS at’, [E1,E2,E3)]]), 
Start (S,_) ’ 
goal(G,_), 
Wieeeeomlist ((“Start =',5,' goal =’ ,G)), 
write list ((’WSO ='’,WS0)), 
write list([’WSC =',WSC]), 
write list([‘WS1 =’,WS1]), 


writeln(’Taking corrective action...returning to WSQ0.’), 
far], 
feemws((5|WS),CW) :- correct_ws(S, [S|WS],CW), !. 


eeurect ws(EQ0, (E1],(E1)) :- 
(ep (E1,E0,R,_,_) ; ep (E0,E1,R,_,_)), 
! 


correct ws(El1, [E2,E2,E3|WS),2) :- 
(ep (E1,E2,R,W,_) ; ep(E2,E1,R,W,_)), 
(ep (E2,E3,R,W,_) ; ep(E3,E2,R,W,_)), 
( edge (E2,_,(_,W],_,_) -> EN=E2, Z=[(E2,E2|CW] 
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; otherwise -> EN=El, Z=CW ), % stripeeure 
correct_ws(EN, [E3|WS],CW), 
t 
correct ws(El, [E2,E2,E3|WS],CW) <= % faulty reentrant 
(ep (E1,E2,R1,_,_) ; ep(E2,E1,R1, ,_)), 
(ep(E2,E3,R2,_,_) 3 ep(E3,E2,R2,_,_)), 
correct _ws(El, [E2,E3|WS],CW), 
t 
correct _ws(E0, [E1,E2|WS],CW) :- % remove El 
(ep (E0,E1,R,_,_) ; ep(E1,E0,R,_,_)), 
(ep(E1,E2,R,_,_) ; ep(E2,E1,R,_,_)), 
correct _ws(E0, [E2|WS],CW), 
t 
correct_ws(_,[E1,E2|WS], [E1|CW]) :- 
correct ws(El, [E2|WS],CW), 
t 
correct_ws(_,WS,CW) :- 
writeln(’ERROR (perturb) ...failed to correct: Ws 7) 
write _list([’WS =',WS]), 
write list([’CW =',CW])), 
bars bp ba Wem or 
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B.2) C INTERFACE AND C CODE 


eaotance ((X1,Y1], (X2,Y2],D) :- 
emstance ( X1, Y1jaex2, YZ, sD) !.; 


wdistance([(X1,Y1], (X2,Y2],W,WD) :- 
mowstance( X1,Y1, X2,Y2, W,WD), !. 


Smelt (PX1,PY1], [PX2,PY2], (W1,W2], 

eet Y 1] (1X0; TYO 15. [EX2-1Y2)2(XOP,4OP]) =- 
emevle(Pxl,PYl, PX2,PY2, W1,W2, 

ial: TXO0, TYO, IX2,1Y2, ~XOrP, YOR), '. 


eeseantcn(D,OW, (SX,SY], [GX,GY], [V1X, V1Y], [V2X, V2Y], D2, [K,Y], LEN) :- 
piiscarchni DOW, SX,SY, GX,GY, VIX, Vie V2X, V2 De, X,Y, LEN); 1. 


foreign file(’/n/ai9/work/kindl/sa/lib/heap.o’, [ 
imat heap, 
del min, 
del heap, 
ins heap 


Jy: 


foreign file(’/n/ai9/work/kindl/sa/lib/snells law.o’, [| 
getable, 
distance, 
wdistance, 
snellc, 
elsearch 
ie 


foreign file(’/n/ai9/work/kindl/sa/lib/rnd.o’, [ 
irand, 
Fanadinit, 
init_anneal, 
metrop, 
iter_impr, 
total _ws 
ioe 
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foreign(init_heap, c, init_heap([-integer])). 
foreign(ins heap, c, ins_heap(+float, [~integer])). 
foreign(del min, c, del _min([-integer])). 
foreign(del heap, c, del heap(tinteger)). 


snellc calls require that getable has been called to load tabledump; 
getable accesses tabledump directly in the current directory 


foreign (getable,c,getable([(-integer])). 
foreign (distance,c,distance(+float,+float,+float,+float, [-float])). 
foreign (wdistance,c, 
wdistance (+float,+float,+float,+float,+float, [-float])). 
foreign (snellc,c,snelle(+float, +float, tfloat,+float, ffiloat, 4 teas 
+float,+float,+float,+float,+float,+float,-float,-float)). 
foreign (elsearch,c,elsearch(+float,+float,+float,+float,+float,+float, 
+float,+float,+float,+float,+float,-float,-float, [-float])). 


Random generators must NOT be cut (!); 
may require re-execution by backtrack. 
randinit calls require access to seed5 
(random digits generated by last run). 


foreign(irand,c,irand(+integer, [-integer])). 
foreign (randinit,c, randinit ({-integer])). 
foreign (init_anneal,c, 

init anneal (+float,+£loat, +£loat, tinteder, +integene 
foreign (metrop,c,metrop(+float,+float, [-integer])). 
foreign(iter impr,c,iter impr (+float, +float, [-imteger])) = 
foreign (total _ws,c,total_ws([-integer])). 


load _ foreign files( [ 
'/n/ai9/work/kindl/sa/lib/heap.o’, 
‘/n/ai9/work/kindl/sa/lib/snells_ law.o’, 
'/n/ai9/work/kindl/sa/lib/rnd.o’ 
ele = dima? ire % Im = lib math 
abolish((foreign file/2,foreign/3]), 
getable({ ). % load Snell’s Law Table 
% tabledump MUST be in current directory 


190 


#include <stdio.h> 

#include <math.h> 

ae ee en ao 6 eee Re oa oe aon ches ac ee eee e- + 
if P,Y,R are adjusted, then revise PSIZE,YSIZE,RSIZE for ocp[][][]; 
also, remember to recompile with revised global.c 

ee a ra a 2 Ds, pe a ee a ee ee x / 


#define TOLERANCE 0.000001 


#define PLO 1 
#define PHI 10 


#define YLO 0.00 
#define YHI 1.00 
#define YINC 0.05 


#define RLO 0.00 
#define RHI 10.00 
#define RINC 0.05 


#define PSIZE 45 
#oefine YSIZE 21 
#define RSIZE 201 


freer OCD (PSIZE) [YSIZE) [RSIZE)], ***ptbl = 0; 
/* NOTE: ptbl=0 ==> table was NOT loaded */ 


int pidx[PHI] [PHI], **px; 


ieee lim = PHI-PLO+1; 
int j_ lim = 1.01 + (YHI-YLO)/YINC; 
ite tim = 1.01 + (RHI-RLO) /RINC; 


FILE *fp, *fopen(); 
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getable() { 
int *pad =e (o1dx (0) (01). 
float *oc = & (ocp (0) (00) )< 
float **occ = &0c; 


FILE *infile = fopen("tabledump", "r") ; 


read (fileno(infile) ,pidx, sizeof (pidx)); 
read(fileno(infile),ocp,sizeof(ocp)); 


pPtbL.~= 4o0ce; 
px = &pd; 


return: 


XLOOKUP - linear interpolation into Snell’s Law table 
x=f(p,y,xr) ==> interpolation of ix=f(i,j,k); table index p is 
obtained indirectly from 2D triangular table indexed by iwl,iw2 


double 
XLOOkKUp(iwliw2,., 2) 


mt 2wl, we - 
double y,r; 


Ln ted pee 
double x, )y,kr, rfactor, Viactorary!), dxr2, dx1 ,dx2; 


/* get table index i for appropriate rho = iw2/iwl 
by convention this routine ASSUMES that iw2>iwl !!! */ 


i = pidx[iw2-1) {[iwl-1]; 
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/* compute indices of square interval for interpolation */ 


see (y-YLO)/YINC; kr = (r=RLO) /RINC; 
ges (int)jy; k = (int)kxr;/* safer way to Sloore*/ 

/* compute orthogonal distances from lower corner of square */ 
Viactor = jy-(float) 3; rfactor = kr-(float)k; 


/* planar interpolation (or linear in 2 dimensions) */ 


dxrl Cer agi ikt1 = sccp lalla iiik) > 
dxr2 = ocp[i]) [j3+1) (kt1] - ocp[i] [j+1] (k]; 
Secle— OcCp(ij]{[j])(k]) + dxrl * rfactor; 

Geez OCD(1i)](j+1](k) +aedxr2 * rfactor; 
eeeecxl + (dx2-dxl) * yfactor; 


if (ptbl==0) printf ("WARNING...Snell’s Law table is NOT loaded!!!\n"); 
return (x); 


} /* end XLOOKUP */ 


WDISTANCE - weighted Euclidean distance between 2 points 

DISTANCE - UNweighted i 
WSQRDIST - weighted, squared" 

SQRDIST - UNweighted, squared" 


a SAREE a a re ve ea x / 
double 

wdistance(xl,yl,x2,y2,w)double xl1,y1,x2, y2,w; 

Wereeura(w * sqrt( (x2-xl)*(x2-xl1) + (y2-yl)*(y2-yl) ) ); } 

double 

Peeeteance (xl, yl1,x2,y2) double xljvl,x2,y2; 
meen (| SOQrt( (x2—-xl)*(x2-xl) + (y2-yl)*(y2=-yl) ) ); } 

double 

sarerst (xl1,yl,x2,y2) double sche y 1, x2, y2; 
Meee ( (x2—x1)*(x2—xl1l) + (y2-yv1)* (y2-y1) ); } 

double 

meaqraist (x1,yl,x2,y2,w) dome, xlevl, x2,y2, W; 


{ return(w*w * ( (x2-x1)* (x2-x1) + (y2-yl1)*(y2-yl) ) ); } 
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#define R 0.61803399 
#define C (1.0-R) 
#define SHFT(a,b,c,da) (a)=(b); (b)=(c); (c)=(d); 
golden (pxl, py1,px2,py2,wl, w2Z,Vx1, Vy1, Vx2, vy 2, Op, Ver) 
float pxl,pyl, px2Z, pyZ, wi, w2, vxlpvy il vx2, Vy2,) XOr, Ven, 
float. ££,10, 20, 22, 23. 
float dx,x0,xl7x2,%35> 
£lOaAEUdV,V0,V 1727 on 


xO) = vxl; yr = vv 
XS = VxZ; ys = vy2, 


Ax = vVxZ-Vx1 dy = fvy 2-1, 


Ki = (CX. axtvxl vi 
XZ 5= R*Gxtvxl; <yZ 


Cedyvaivy ls, 
R*dyitvy il: 


fl = wdistance(pxl,pyl,xl,yl,wl) + wdistance(px2,py2,x1,yl,w2); 
f2 = wdistance(pxl,pyl,x2,y2,wl) + wdistance (px2, py2, x2, y2,w2) ; 


while (fabs (x3-x0) > TOLERANCE* (fabs (x1) +fabs (x2) ) 
|| fabs (y3-y0) > TOLERANCE* (fabs (yl)+fabs(y2))) { 


cietsnae( tea tly aa 
SHFT (x0 1 x2,,R*x14+6253)e 
SHFT (v0, vl,y2,R*vi1te*7 Vs) 
ff = wdistance(pxl, pyl, x2,y2,wl) + wdistance (px2,py2, x2, y2,WZ), 
SHE TiGEOr- Gi f2. ef): 
} 
else { 
SHFT (x3, x2, 20 -R* x2 +CKx0) ; 
SHEDT(y3 v2 gy lak <*v2te*x v0); 
ff = wdistance(pxl,pyl,xl,yl,wl) + wdistance (px2,py2,x1,yl,w2); 
SHE Gio, ft 2 eet oe 


*xOp = (0Go* (xt Ze, 
*vop = UPS (yi: 
return. 


} /* end GOLDEN */ 
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SNELLC - computes Snell’s Law crossing point (xop, yop) 


aby 2s ee) ER i re ee ee ee See ek x / 
Peewee (Ox, py ll, px2,py2, Wl,W2Z, 1x1, 1V1, 1x0, 1v0,1%2,1y2, XOp; Yop) 
float Pel pyVl Ee xXcHeVe Wl, Wl, 1x), TV, x0, 1 VO, axe, Lye, ~XOD, “YOR; 
{ 
int iwl,iw2; 
double x Xbe ve ve, by pare, 
iwl = nint(wl); iw2 = nint(w2); 
if (iwl == iw2) {/* should NEVER be used, computed in Prolog */ 
*xop = 1x0; 
xyop = iy0; 
return (-1); /* -1 = NO computation performed */ 
} 
Pe istance (ixl,iyl,ix2,iy2); 
y = distance (pxl,pyl,ixl,iyl); 
wee y + distance (pxZ,pyZ,1ix2,1iy2); 
y = y/yt; /* compute normalized y */ 
be xt/yt; 
if (y>0.01 && y<YHI && r>0.01 && r<RHI) {/* check if in table */ 
feewl > iw2) /* check correct orientation */ 
f= 1.0 = xlookup(iw2,iwl,1.0-y,r); 
else 
pee x lookup (iwl,iw2,y,r); 
Bact = x/r; /* optimal partition of edge between i1,12 */ 
kxop = part*(ix2-ixl) + ixl; 
xyop = part*(iy2-iyl) + iyl; 
mBecurn (1); /* 1 = table lookup was performed */ 
} 
else { 
pemeen(pxl,pyl, px2,py2Z, wl, w2, 1x0, iy0,1ix2,iVyv2, xop, yop) ; 
return (0); /* 0 = golden search was required */ 
} 
} /* end SNELLC */ 
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a ee ee ee ewe Soe eee Se ee a x / 
float 
elsearch (bestc, Ow, SX, SY, G%, GY, X10, Yin, XOUt, YOUL,COouc, x0,5 vu) 
float bestc,ow, Sx, SY, GX, GY, X1N, Vin, XOUEp your, coulLn{x0;, VOR 
{ 
float) x;y, c, x1, yl, te1—0.001- 
xl=xin; yl=yin; 
c=cout; 
while (fabs(c-bestc) > tol) { 
x = 0.5% (xin+xcut)-; 
yy =1025"(yvinhvouc) 
c = wdistance(sx,sSy,x,y,ow) + wdistance(gx,gy,x,y,Ow); 
if -(c.> bestc) {| xouts—-x,; yout = Via) 
else { xin = x; yin = y; } 
} 
*xQ=x; *yO=y; 
return ( distance(xl,yl- xy) ) /* new length of edge */ 


} /* END elsearch */ 
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mm ees ew es es se 
cc cr ce ee cr ce cr cr cc ee ee ee ee ee ee ee ees ee ee ee ae ae ae ae 


#include <stdio.h> 
#include <math.h> 
#include "statel.h" 


#define DIGIT 4 
#define MAXINT Ox7FFFFFFF 


Hees “fp, *Lopen() ; 
unsigned seed = 1; 
float fmaxint = (float) MAXINT; 


Annealing parameters (global): 


ce cc cr cer cr cr cr cr cr cr cr cs cs ec cs cc ee es ee ee ee ee 
—————— ss rrr Lr _ __.._.._..._.._.._._..._..__ iil 


/* random list of numbers */ 


/* file pointers for seed5 */ 


Beftane change in cost function as: dc = c[i] - c[itl] 
Then dc > 0.0 implies cost improvement, accept at p = 1.0 
and dc < 0.0 implies cost degradation, accept at p = exp(dc/t) 
Thus, function metrop(dc,t) should operate as follows: 
Becwrnine(dce-=s0'.0) [| (rand0l{) < exoi{de/t)) - 1:0 } 


Giteat titactor; 
float temp; 
Elvoat tfrozen; 


Mitten total = 0; 


/* temp reduction factor (eg .9)*/ 
/* current temperature*/ 
/* current temperature*/ 


/* total attempted moves all t*/ 


/* The following stats are accumulated at each temperature temp*/ 


inieem Limit ; 
Means limit; 
oneen = 0; 
Mens = 0; 


int n_imp = 0; 


eloae Sum dc deg = 0.0; 
float mean _dc deg; 


float sum c = 0.0; 
float ss = 0.0; 
float mean; 

float sd; 


/* max attempted moves (eg 100) */ 
/* max successful moves(eg 10) */ 
/* attempted moves*/ 

/* successful moves*/ 


/* attempted moves @ dc >= 0.0*/ 
/* n deg = n = n_imp*/ 


/* sum of dc degrading*/ 
/* <dc degrading> = exp val dc-*/ 


/* sum of c*/ 

/* sum of c*2*/ 

/* <c> = expected value c*/ 
/* std deviation of c*/ 
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IRAND(K) - generate random integer in range [0..K) 
eee ee ee x / 
sete 
imand.(k) ant k? 4 
if (k>0) return(random() % k); 
else printf ("ERROR...attempt to call irand(k) for k<—O\n je 
} /* END irand */ 
| Ras aa a a a 

INITSEED() - generate a new seed from the system clock 
aoe Sb been SS ee Se ee Se ae ee a ee a ee x / 
unsigned 
initseed() { 

unsigned t,curtime, loctime, save, oldsave; 
/* 
MUST call time(0) (ie. arg = NIL pointer) to ensure that time 
does NOT store return structure on top of program variable space. 
aT 
curtime = (unsigned) time (0); /* no of seconds since 1 Jan 1970 */ 
if (fp = fopen("seed5","r")) { 

fscanf (fp, "td", &0ldsave) ; 

Lclose (rp); 

} 
else 

oldsave = 2311; /* some large prime number */ 
t = (unsigned) exp10( (float) DIGIT); 
loctime = curtime % t; /* last DIGIT digits */ 
seed = loctime*oldsave + loctime + 13; 
save = seed % t; /* last DIGIT digataaae 


fp = fopen ("seed5", "w") ; 
forintft (Lp, “sds 7save) ; 
fclose(fp); 


printf("\ncurtime = %12d\n",curtime) ; 
printf( "loctime = %12d\n", loctime) ; 
pranti ("= t1i2Zdwneee 

printf( "oldsave = %12d\n",oldsave) ; 
printf( "(new)save = %12d\n", save); 
printf( "seed = %12d\n\n", seed) ; 


return (seed) ; 
} /* END initseed */ 
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RANDINIT() - initialize new random seed and statel for random() 
a cee Pa ee ee ee ee ee ee eee eee ee x / 
unsigned 
mandinit() { 

int n = 256; /* total no. bytes in statel = 4*64 */ 
initseed(); /* to change seed */ 
initstate (seed, statel,n); /* to initiate state with seed */ 
setstate(statel) ; /* to use statel */ 
/* srandom(1); /* generates SAME sequence each execution */ 
srandom (seed) ; /* generates NEW sequence each execution */ 
return (seed) ; 
} /* END randinit */ 
ee eee ee ee oe Se eS ee ee ee ee ee eee 
GENSTATE() - generate a new statel 
noe See ee ee ne ee ee eee ee er x / 
genstate() { 

ant a, Size = 64; 
meamaanit () ; 
moe Lopen(“statel.h", “w") ; 
fomimit (fip,“static long statel[64] = {\n"); 
for (i=1; i<size; itt) 
memini.t (fp, "415d, \n", ixand(1000000000) ); 
Bomomet (f£p,"t15d )};\n",irand(1000000000)); 
imelese ({[p) ; 
} /* END genstate */ 
(OL ee et SS BE 3355 ee a eee 
rand0Q1() - uses random() to generate random number on [0,1) 
ee oe ee ee ee ee ee a a ee ee ee a a a ee a a ee ea ee es ee x / 
float 
rand0Ql () 
{ return( (float) random() / fmaxint ); } 


/* to extend range returned by rand0l, use this call: 
return((float) random() / (float)Ox7FFFFFFF * range); */ 


ee 


[Rone concn n onion sa oe eee aoe e eee ee a a ee eee 
init_anneal() - initialize annealing parameters 
se i a a ea ec x / 
init_anneal(ts,t0,tfac,n0,ns0) 
float tse Vest Lac, 
ane nO, ensur 
{ 
Lemme: — Us, 
tfrozen = t0; 
traccou = trac, 
notimit | 0; 
ns limit) = ons: 
n= 0; 
ns = 0; 
Nobotal =o; 
Prine... 
prantf(" starting temp = 9%6-.Z2£\n" es). 
printf(" freezing temp = %8.2f\n",t0); 
printf (“ temp reduction factor = 28.21 \n, clac)- 
printf ("max perturbations per temp = %8d\n",n0); 
printf (" max successes per temp = %8d\n",ns0); 
PEInNcCEG va); 
printf(” temp n ns dct de= <de=> <c> sa cum\n:); 
PLANtE ("9 a a nn ne = ___ ee MO) 
Draintt() \au 
}/* END init anneal */ 
vy, ee 
cool() - reduce the temperature (temp) per annealing schedule; 
may be modified for more elaborate cooling schemes 
ww eee esas Se SSeS See a as Ss es Be ee x / 
Cool) t 
int den; 


den =n - n_imp; 

if (den == 0) mean de deg — 0207 

else mean_dc_deg = sum_dce_deg/ (float)den; 

sum_de deg = 0.0; 

mean = sum_c/(float)n; 

sa °= sGret (ss/ (float) (n-1) )- (mean*summc, (etoat i m-))).), 
sum_c = 0.0; 
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“eeolcal = n total + n; 


eermer("$7.1f 3d $3d %3d 43d 48.1f£ 37.1£ %7.1£ %4d\n", 
temp,n,ns,n_imp,n-n_imp,mean_dc_deg,mean,sd,n_total); 


Sembee] tfactor * temp; 
n = 0; 
n imp = 0; 


if (ns == 0 || temp <= tfrozen) { 
printf(" freezing temp = %8.2f\n",temp) ; 
printf ("total perturbations evaluated = %8d\n",n total); 


return (0); /* HALT - effectively frozen */ 
} 
else { 

ns = 0; 

merurn(1) ; /* continue annealing */ 


} 
fee END cool */ 


metrop(cl,c2) - returns l-accept/0O-reject or -1 if frozen 
cl = current cost; c2 = new cost; 


Meeroo(cl,c2) float cl,c2; { 


int determ; /* determinant = accept 1 or reject 0 */ 
int improve; /* 1 if de non-negative */ 
ZEGat, AC; 


Gen) cl-c2; 

Tact: tes 

Sumac — Sum c + c2; 

ss = ss + (c2*c2); 

iiereve = (dc > 0.0) ? 1:0; 


if (improve) n_imptt; /* n deg =n - n_imp */ 
else sum_dce_deg = sum_de deg + dc; 


determ = ( improve || (rand01() < exp(dc/temp)) ) ? 1:0; 
ns = ns + determ; 


Paminrer— To limit |{ ms >= ns_ limit) { 
if (cool()) return(determ) ; /* continue annealing */ 
else { n=0; return(-1); } /* HALT - effectively frozen */ 


} 


return (determ) ; 
} /* END metrop */ 
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iter impr(cl,c2) - iterative improvement; returns l-improves/0-reject 
cl = current cost; c2 = new cost; 


meee eee eee eee eee eee ee oa 5 ee ae a ee ee x / 
iter ampr(el, ¢Z2) fteae eect 

Midaates 

if (n <= no Jimie) ereturn< (cl-c2 >— 00 ees), 

else { n=0; return(-1); } 

} /* END iter_impr */ 

[Jkooeobose snobs lesseses seh eas 6 ee sees Sa ee 
total ws() - returns total number of window sequences evaluated 

Sete cei oses ness close esse ceseS eee =i a ee ee eee x / 


Gotatews() “ieseccurn(abotal) > | 
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#include <math.h> 
#define NULL 0 
#define MAXHEAP 100000 
Bemuce heap item { int cost, hash; }; 
Struct heap item heap[MAXHEAP] ; 
int 1, hashcount = 0, heap size = 0; 
DOMMM@ foe on oto 5 ll. 3 cole e Se eee eee oe ee a Se 
INIT HEAP 
a 2 eg eee Ce eet =) 2 o Eee */ 
init _heap() { 
heap size = 0; 
hashcount = 0; 
for (1=0;i<MAXHEAP;i++) { 
heap[i].cost = -1; 
heap[{i].hash = -1; 
Os 
} /* END INIT HEAP */ 
Coo i a ee ee ee 
pled UP - heap routine 
a a ee gl av i UR ne ae x/ 


Pmereup(k) int k; { 
int parent; 


if (k > heap_size) 
printf ("ERROR...Attempted to sift _up an element not in heap!\n"); 
while (k > 1) { 
parent = floor((double)k/ (double) 2); 
if (heap[parent].cost > heap[k].cost) { 
interchange (parent,k); 
k = parent; 
} 
else return(NULL) ; 
}; 


ime end SIFT UP */ 
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ins Neap(Cest)) ine oseam, 
int hash; 


hashcount++; 
heap_sizett+; 
hash = hashcount; 


if (heap _ size >= MAXHEAP) 
printf ("ERROR...Over-extended heap!"); 


heap[(heap_size]).hash = hash; 

heap(heap size].cost = cost; 

if (heap. size > 1) Sift sup (heapusize), 
return (hash) ; 


} /* END INS HEAP */ 


SEC TGOwn(k )e nth et 
ou 9y cma Ws 


if (k > heap _sizetl) { /* k might be the old last element */ 
printf ("ERROR...Attempted to sift_down element not in the heap!\n"); 
printf ("k = %d heap size = %d\n",k,heap size); 

} 


do { 
Je Skis 
if (2*j) <= heap size && heap(2*j].cost < heap(k) -cose, 
ee aly 
if (2*j < heap size && heap[2*j+1].cost < heap[k].cost) 
ko S-2* te 


interchange (k, }); 
} while (3 !=k); 


} /* end SIFT _ DOWN */ 
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DEL MIN - returns top of heap (minimum) and restores heap property 


INI 2 Se oe eee ee ee re eee eee eS ee a) 
del min() { 
int Loot; 

gif (heap size > 0) { 

root = heap[1].hash; 

interchange (1,heap_size); 

heap[heap_size]).hash = NULL; 

heap [heap size].cost = NULL; 

heap _size--; 

if (heap_size > 1) sift _down(1l); 

Becurn (root) ; 

} 
else { 

printf ("ERROR...Attempt to delete from empty heap!\n"); 

return (NULL) ; 

}; 

} /* end DEL MIN */ 
ee ee ae Se ee Eee Sco S eee eee Se 
DEL HEAP - delete from anywhere in heap; requires linear search 
a ee ee ee ee ee eae oS See x / 


del heap(k) int k; { 
imc 1 = 1; 


if (heap size > 0) { 

while ( (heap[i].hash != k) && (i < heap size) ) i++; 

interchange (i,heap_ size); 

heap([heap_size].hash = NULL; 

heap [heap _size].cost = NULL; 

heap size--; /* heap[heap_ size] is now last element */ 
if (heap _ size > 1) sift _down(i); 


} 
else printf ("ERROR...Attempt to delete from empty heap!\n"); 


} /* end DEL _HEAP */ 
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interchange (parent,child) int parent,child; { 
Struct heap item hold; 

hold = heap[parent]; 

heap[parent] = heap[child]; 

heap[child] = hold; 


} /* end INTERCHANGE */ 


206 


TABLE.C - table generation, read, dump, get routine 


SSS SSS SSS SSS SSS SSS SSS SSS SSS SSS SSS 555 SSS SSS SSS SSS S55 SSS SS SS S>=% ii 
fenciude “global.c" 

ee eens Ss ee eee ee eee 2 eee eee oe eee ee 
GENTABLE.C - generate Snell’s Law lookup table for crossing episodes 
Cee Hee ee ee ee ee a x / 


gentable() { 


mi@ae Vl,V2,r,P0, Pp, Xr Viel, ee; 
eH ley Jy Ky mM, te Lam; 


fp = fopen("slidata0", "w"); 


i lim = PHI-PLO+1; 
eer — (i lim*i lim - i lim)/2; 


1 = -1l; 


ieotem—F LO-1; m<PHI; m++) 
hon (n—PLO-1; n<m; nt++) { 
pO = (float) (m+1)/(float) (n+1); 
i++; 
pidx[(m](n]} = i; 
Mmoerntr (Lp, "sd\n",pidx(m) [n)); 
mor (j)—-0; <j lim; j+t) { 
y = (float) j*YINC+YLO; 


Bom k=O; kK<k tam, ki) { 
ee KElOaL) K*RINCTREO; 


vl = 0. 
il 


Oe 2 = =o 
el = 0 


3; e2 = 1.0; 
while (el>TOLERANCE && e2>TOLERANCE) { 


x = 0.5* (vlt+v2); 

p cos (atan(y/x))/cos(atan((1.0-y) /(r-x))); 
Tep<p0) Vl = x; 

else v2 = x; 

el = fabs (p0-p); 

e2 fabs (v2-vl); 


i 


H 


} /* end while */ 
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forintt (fp, sesof\m sou, 
fflush(fp); 


)} /* end for */ 
} /* end for */ 
} /* end for */ 


fclose(fp); 


} /* end GENTABLE */ 


READTABLE.C - read table in ascii format (sldata0) 


Peadt ap len mt 
int: myn, 14°), 


ptbl = (float ***) malloc( (unsigned) j lim*k_ lim*sizeot(tlcar= ae 
px = (int**) malloc( (unsigned) (PHI-PLO+1) *sizeof (int*) ); 


fp = fopen("sldata0", "r"); 
Printi ("Loading Snell’ s3kaw table...) 
LELusSh(SsedourjE, 


for (m=PLO-1; m<PHI; m++) { 

for (n=PLO-l  enam- nt te 
Escant (fp, td" 7so210x (minal) 
1 = pidx{[m) [n]; 
fOr (j-C;e ae et) 

for (k=O; k<cke lam ke) 
fscant (fp, sf ,40cp 1 aj ele, 

} 

PEInNtr ( sa" "ang 

fflush(stdout) ; 

} 


PRINCE eerdone:. \ni') - 
£flush (stdeuce)- 

fclose (fp); 

return; 

} /* end READTABLE */ 


208 


DUMPTABLE.C - read ’sldata’ in ascii, dump core image to ‘tabledump’ 


ee ee eh ea gg ag a eg Rn re x / 
dumptable() { 
FILE *outfile = fopen("tabledump0", "w") ; 
readtable(); /* requires table in ascii form (sldata0) */ 
write (fileno(outfile),pidx, sizeof (pidx) ); 
write (fileno(outfile),ocp,sizeof(ocp) ); 
Gieliush (outfile) ; 
Beturn; 
} /* end DUMPTABLE */ 
/* oS SS ee 
GETABLE.C - reads core dump of table (tabledump) 
oo oo ee ee ee a x / 
getable() { 
ge “pd = &(pidx[0)(0))-; 
float *oc = &(ocp[0)] [0] [0]); 
Eloat §~*OCC — &OC; 
FILE *infile = fopen("tabledump0","r") ; 
read (fileno(infile) , pidx, sizeof (pidx) ); 
read (fileno(infile),ocp,sizeof(ocp)); 
pEot = &0CC; 
px = &pd; 
meturn ; 
} /* end GETABLE */ 
MEE Sn i a a a ee ee eee x / 
main() { 
gentable(); /* generate sldata0 (ascii) */ 
dumptable() ; /* execute readtable() and dump tabledump0 (binary) */ 
getable(); /* load to check for correctness */ 


} /* END main */ 
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B.3. UTILITIES AND PRIMITIVES 


mr re me a as a es i i 
eT OL Sm ee ae i Se 


Run Quintus Prolog in your root with this file called prolog.inigange 
your regular prolog.ini file renamed to init.pl. After you receive 
the normal Q-Prolog opening message and prompt, enter ‘/make(name) .’ 
to save the state in executable form as ‘name’. Henceforth, you must 
Start Quintus Prolog by entering /name’ in Unix. This will rapidly 
load compiled versions of all libraries requested below, and give you 
the prolog prompt. 


Compile ("1lib/init 9), $ contains root and xload definitions 


use _module(library(math),all), % append, member, memberchk, nonmember 
use _ module (library (basics),all), 
use_module (library(lists), [ 

last/2, 

rev/2, 

eS aes tee, 

neno/3; 

neh 3; 

delete/3 J), 


use_ module (library (sets), [subtract/3,subset/2]), 

use module (library (strings), [concat/3,concat atom/3]), 
use module (library (files), [file _exists/1]), 

use module (library (ctypes), [is _endfile/1]), 

use_module (library (dialog) ), 

use_module (library (interpret_messages)), 

use module (library (messages) ), 


xiCad(” bep/utii"), 

x loads -b/ line Bre 
xloadi@1lib/ pwin we 
xload('lib/pre’), 
xload(’lib/ellipse’), 
xload(’lib/udp’), 
xload(’lib/optimal’), 
xload(”’ Iaib/ sor’ je 
xload(* lib/ foreign: ji, 
xload(’lib/start’), 
xload(’lib/mouse’), 


ZG 


Sload(?1laib/stats’), 


nie weitein (’ enter “make (P)."" to create executable: ''R’" ."). 


mane (P) :- 
save(P,1), % remaining statements execute at start-up of P 
nis, 
wreoteln(’O-Prollog Rel. 2.5 (SPARC) >. custom vers 5 Nov 90’). 

make (P) :- 


nl, write(’Created custom vers of Q-Prolog: '), 
writeln(P), 


halt. 
Monesexec(P) :- save(P,1), background. 
marerexec( ) :- halt. 
background :- file exists(’run.pl’), compile(run) .3 background 
background :- start. %$ interactive 


oul 


library directory (’ /usr/local/quintus/generic/qplib2. 5/librasy ee 
library directory(’ /usr/local/quintus/pwl.1/library’). 


root (‘ /n/ai9/work/kindl/sa/’)- 
xconsult (F) :- filepath(F,PATH), consult (PATH). 
xloadte) == filepathih, PATH) ensureuloaded (eins 
filepath(F,PATH) :- 

rOGe (Di, 

name (D,L1), name(F,L2), 


append(Ll1,L2,L), 
name (PATH,L). 


not (X) :- \+ X. 


oo 


>- unknown (X,fail). % call to unknown predicate simply fails 
:- unknown(X,trace). + (default) trap to debugger 


ae 


oe 


append([],L,1L) - 
append([X|L],R, [X|List]) :- append(L,R,List). 


ae 


Ssys(STRING) :- unix(system(STRING)). 
writeln(X) :- write(X), nl. 

writelnin(s) = write (X%) onl. nl. 

writeln(S, xX) s— 'weite(S,x), nlts). 
writelnln(S,X) :- write(S,X), nl(S), nl(S). 
writelneb (x) =: —sbolld, write (xX), nl,.alleotc,a 


write istic. ml, 
write Jist( (x)Gle:— write (XxX), write(’ 4) pevetecm acme) a. 


write list (b(x):— bold, write lists)  faltorr. sn « 
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same (X, X). 


els :~ Gisplay('’*L’). % clearscreen or page 
Mees notrace. % shorthand code 
moe :- nospvyall. 
ioe. :—wlisting(X). 
emmp (P) .:- % dump listing of predicate to file 
open(P,write,S), 
Eells), 
listing(P), 
eo 1c 
a ae ak a a a ee ee ee ee 
Enhancements to On-Line Help / Manual 
a se SP a aC oe eR Oe Ee nen pe ve oT re 7 
inane: —- manual. 
Mee manual. 
m(X) :- manual (X). 
Mien :=> Sect (S, SEC), manual(-(SEC,N)). 
Meo, N,P) :- sect (S,SEC), manual (-(-(SEC,N),P)). 
ieee, OQ) ¢<— sect (S,SEC), manual (—(-—(-(SEC,N),P),Q)) . 


sect (u,user). 
sect (r, ref). 
sect (s, sysdep). 
sect (1,1lib). 
sect (p, pw). 


rex) 3 
name (X,L), 
eiar last ({L,CL), 
append({m],CL,MLIST), 
Mes MLIST, 
call(M), 
' 

ue) 3 


writeln(’ERROR...Invalid use of h(X)...’), 

Vision.  < mists be form, of (sd ‘7°! sda’. or *! sddd'*')., 
writeln(’ s = u(user), r(ref), s(sys), or 1(1ib)’), 
Witeeim(’ Gd = Gigit 0.9 [1f -d29, yuse torm m(s,d,d,d)) ).. 


@inar list ([],{)). 

ear last ((N|L),{(C|CL]) :- 
name(C,[N}), 
ehar list (b,c) - 
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VT-100 Terminal escape sequences 


Sees see Se ae ae Se ee ea a a a a se Se SS Se Se Se Se a Sa Se a a a Sa a SS Se Sa Sa SS Sa Sa aaa eae X* y 


eb :- esc, lbrack. 

clear := eb, two, 7uy- 

home :- eb, uh. 

reverse :- eb, ques, five, lh. 
normal :- eb, ques, five, 1l. 
Smooth :- eb, Ques, L£oOur, 1. 
SCE NOrmM -= Cb, ques ucur a 
backup :- esc, um. 

SaVENCUn @)= Gee, scven: 
FeStecue ese, Coie 
Cur(L;C) "s= esc,7 uy, writeth, 
alloff :-— eb, zero, im. 


bold :- eb, one, lm. 
under 


[= €b, s£0ur, em. 


blink :- eb, five, lm. 
rvideo :- eb, seven, 


ASCII display codes 


esc 9 7—*pue(Z)) = 
ZELO 13 = 1 pue (46). 
one :- put (49). 
EWOrr = DOr 50) x 
three :- put(5l). 
£OUL 2 IpuL (oc) 
LIVE —TpUE oops 
Six == Puce) 
SEVEN >= PUES). 
ei1gnt..2 = put (56). 
nine = —) putio7)- 


ques §.— put (63) 
lbrack spur o2)e 


la := "put (997). 
In © =" peu G04) 
i) {=u Ge) 
im <= aaoute (PU gne: 


un 2 =3pue 2 
uy 2- pul Cae 
UM. "f= DUE 7a )e. 


WY 9s = Fou). 


ii. 


(used above) 


write(C). 


214 


% escape, left bracket 
%$ clear screen 

%$ home cursor 

%$ reverse screen 
normal screen 
smooth scroll 
normal scroll 
reverse index 


of oP 


of oo? 


% turn off all attribeges 
%$ bold attri 
% underline attrib 
% blinking dttewe 
%$ reverse video attrib 


% escape 


$ numerical digits 


oP of 
— 4) 


% lowercase alpha 


% uppercase alpha 


em a we ee ii 
ee ccc cr cc cc ce ce ce ee ee ee ee ee ee ee ee ee ee ee 


irandom(A,B,IR) :- 
RNG is B-Atl, 
irand(RNG,N), 
ERSiseNtA, 


Eemestart :- statistics(runtime, ), 


timemark(TIME) :- 
Statistics (runtime, [_,T]), 


ee dd 
——————— 


% random integer range A..B inclusive 


% format (’~3d sec CPU time~n’,([T]), 


TIMe 1s T/1000,; 
t 


Boe:- timestart. 
Em 2—- timemark( ). 


bint tl) :— timemark(T). 


eee ee ee ee ee ee ee ee ee ee ee ee ee es ee ee ee ee ee ee ee ee ee ee ee ee ee ee i ee ae ae 


:- dynamic tolerance/1. 


tolerance (0.000001). % default tolerance, change with asserta 


Termin tolerance (((X1,Y1], (X2,Y2}]) :- 
aps Gvtt(xl, X2;,DK), abs diff (Y1,Y2,DY), 
tolerance (Spec), 


i % do NOT get another tolerance Spec */ 


DX < Spec, DY < Spec. 


peoecdtf£f£(Xl,X2,AD) :- X1=<X2, AD is X2-X1, !. 
eomGttfl(Xl,X2,AD) :—- AD 1s X1-X2, !. 
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pi(3.14159). 
half _pi(1.5708). 


Ead.,deg(R,)) «:-> 
not(var(R)), var(D), 
D is R*180.0/3.14159, 
t 

rad deg (Rk, DP) s:— 
var(R), not(var(D)), 
R aS BD 3.141597 18020, 
! 


rad deg(_,_) :- writeln(’ERROR (util)...rad deg needs a constant.” jy 


absolute (X,X) :- X>=0, !. 
absolute(X,AX) :- AX is -X, !. 


between((X1,Y1), (XM, YM), (X2,Y2)) :- 
number between (X1, XM, XZ), 


number between (Y1, YM, YZ), 
! 


number between(A,B,C) :- A=<B, B=<C, !. 
numper begween (hi, B,¢)  . = A>=B) B--C 
number: bDeeween ia, 8; ©) .:- 

close enough (A,B), 


close enough(B,C), 
' 


Close _enough(N1,N2) :- 
Dis N1-N2, 
fabs (D,AD), 
AD<0.0001, 


wedupach (Pape caw Wi eee 
wdistance(P1,P,W1,Cl), 
wdistance (P2,P,W2,C2), 


CG rss elt+CZ, 
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closest (PR,P1,P2,PC) :- 
Sac cist (PR,2 4, sDije, 
Sqr Gist (PR,P2,S0D2)., 
nearer(P1,SD1,P2,SD2,PC), 
t 


Sweedist ((X1,Y1),(X2,Y2),SD) :- 
DY is Y2-Yl, DX is X2-xXl, 
SD as DX*DxX.+ DY*DY, 
' 


nearer(P1,SD1, ,SD2,P1) :- SD1=<SD2, !. 
Semen (t, ,F2,.,P2) :- !. 


ZG 


ensure _loaded(library(math)), 
xlodad( lth uaa) 


intersect (Pl1,P2,P3,P4,I) :- 
line (P1,P2,ABC), 
line (P3,P4,DEF), 


intersection (ABC,DEF,I), 


Line ( (x.y ie( Xe 00 ee % degenerate line = point 
write list([’WARNING (line)...degenerate line at’, [X,Y]]), 
t 
mE eV =o i>, med (0.4 rrme i CL 9s Olea O icy) Bas Sy % infinite slope line = vertical 
Wea ey lea ee Sle OO etre Oy 1) ) ee ee % zero slope line = horizontal 
line C(x, Yili. .(%2, 72) 0A Be) = 
DX is X2-xXl, 


line2 (Dx, (X1, 21), (XZ, Y¥2], (A,B Se) 
! 


Line2z (DX; xl yal Re el, Cr Oar ee % near vertical 
fabs (DX, ADX), 
ADK = 020017 
XM 3550 55*% (Xl+k2); 
t 
lineZ (DX, [x14 1) (bee y2 1A, 1 20 epi 
A is (Y¥1-Y2)/DX, 
C is (Y¥1*X2-Y2*X1) /DX, 


INTERSECTION CONDITIONS: 
DEN = B*D-A*E = 0 AND B*F-C*E = 0 
==> coincident or degenerate lines 


DEN = B*D-A*E = 0 AND B*F-C*E /= 0 
==> parallel lines 


intersection (AS, Cl. (Deel le 
DEN is B*D-A*E, 
Intersect yonz (DEN] (A, B,C], (DAE Fle 1) 
t 
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iieeDoeCtlonZ (DEN, [A,B,C], .,coancide) :- 

DEN =:= 0.0, % DEN requires explicit zero check 
% write list([’WARNING (line)...coincident lines L =’, [A,B,C]]), 

t 
ice rsectlon2d (DEN, [A,B,C], [D,E,F],(X,Y]) :- 

hs) (82 -C*E) / DEN, 

moss (ACH —C*D)/ {-DEN), 

t 


imeapoint ([X1,Y1], [X2,Y¥2], [MX,MY]) :- 
MX is 0.5*(X1+X2), 


MYoasa055* (YI+Y2) , 
t 


eeeition(P, | [X1,Yl], [XZ2,Y2]], [Px,PY)) :- 
PX is P*(X2-X1) + Xl, 
PY is P*(Y2-Y1l) + Yl, 
! 


Ep-=penemeular(([PX,PY], [A,B, J, [PX,PY]) :- 
A =:= 0.0, B =:= 0.0, 
writeln(’WARNING (line)...perpendicular to degenerate line’), 
t 
perpendicular ([(PX,PY], [A,B,C], [X,Y]) :- 
T is B*PX - A*PY, 
is A*A + B*B, 
Bona Gt Bi) Dp, 
is (B*C - A*T)/D, 


SEG Ge 


Beagding((X,¥),(X,Y],_) :- 
write list([‘WARN (line)...degen line’, [X,Y],’has no heading’ ]), 
We cai. : 

meocomg((Xl,Y1lj, [X2,Y2]),H) :- 
w2<Y¥ 1 X2<X1, 
Meaduna2 (XZ, YZ), [X1,Y1],H2), 
H is H2+180.0, 

! 

Meacgang((X1,Y1], (X2,Y2),H) :- 
Wen < Y 1!) 
heaginge Giaz,¥2), [X1,¥1],HZ), 
H is 180.0-H2, 

' 

Peading ( [X1,Y1], [X2,Y¥2],H) :- 
xZ2ox 1, 
Neadune. ([ x2, 724) (Al, YL) ,82), 
H is 360.0-H2, 
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heading ([X1, YL], (427.217) a 
heading2 ( (Xf, Yl, | x2, eZ oe 


heading2Z (([X1,Y11;7 (42, Y2), 
DX is X1-X2, DY is Y1-yY2, 
fabs (DX, ADX), fabs (DY,ADY), 
ADX>ADY, 
Q is ADY/ADX, atan(Q,AT), 
HS 690 70-(5722957795Si5 ar) 
t 

headingZ (xl yee eZ 
DX is X1-X2, DY is Y1-Y2, 
fabs (DX, ADX), fabs (DY, ADY), 
© is ADX/ADY, atan(Q,AT), 
Has 5722959 79512 An, 


relative heading - clockwise difference (0..359+) between Z hegemtnge 
back heading - used to link edges and find regions 


meen ee Se ea x / 
relative heading (Hl, H2,83) :— H3 2s H2-H1, Hs>-0) 

relative heading (Hl,H2Z,H3) := H3 1s) 360-—(H1l-H2) 

back heading(H7 He) 2-H < 1e0207 seis Bt eOnO ee 


back Neading (Hae ))):- He as H-1c0eC pa. 
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B.4 USER INTERFACE 


:- use _ module (library(files), [file _exists/1]), 
use_module(library(ctypes), [is _endfile/1]). 


6 shorthand(s,start,s0,1). $ for reference only 
% shorthand(g,goal,g0,2). 


Start :- % interactive session 
cls; 
bold, ni, 
Poeompte( , Enter MAP name: ’), xread(MAP), 
moot ROOT), 
concat (ROOT, 1lib/’, LIB), 
concat (LIB,MAP, LIBMAP), 
aller t «onl, 
pre (LIBMAP), 
Start prowindows, %* contained in pwin.pl 
Wereelm Coonummatce format is (x;y). Range [0..100,0...100).7), 
enter point(s), 
enter point (g), 


tail sequence, 
t 


Start (N,MAP,S,G) :- $ background job 
TOOL (ROOT), 
comecat (ROOT, lib/*, LIB), 
concat (LIB,MAP, LIBMAP) , 
pre (LIBMAP), 
set_sg(s,S), 
Seems (, 3) ; 
show_parms, 
go, 
stats(N), 
! 
erare (N,MAP,S,G) <:- 
writeln(’WARN (start)...failed to start!’), 
Wiitewlact (lor rob No.’ ,N)), 
write list([’ Map =’,MAP)), 
Wikeec ul toe@eotart =" 775 ))), 


Woreeoulase((” Goal =',G)), 
' 


py) | 


new :- new(s), new(g), !. 


new (X) 


nil; 

retractall(ep(X, ,_, ,_)), 

mapname (MAP), 

shorthand (X,XXXX,_,_), 

write list ({‘Reinitialize’ ,XXXX,‘for’,MAP]), 
writeln(’Coordinate format [x,y]. Range [0)..100,05-100]% 32 
enter point (X), 


tail sequence, 
! 


enter point(s) :- 


bola,] nis, 

prompt (_,’Enter new START: ’), read(P), 
al lotte 

set _sg(s,P), 


w_showsg(s), 
! 


enter point(g) :- 


= 


bola-aene- 

prompt (_,’Enter new GOAL: '), read(P), 
allo£et, 

set_sg(g,P), 

w_showsg(g), 


store :- mapname(M), store(M). 
Store (Mj. = 

COnCat(M, Vere 7, MPRE), 

save (MPRE,1), 

reinitial. 
SEGrC KI .. 
réinitial := weanit, tart sequence. 
recall :- mapname(M), recall(M). 
recall(M) :- 


COonCat(M, =pre (MERE), 
recall2(MPRE). 


recall2(MPRE) :- 


file exists (MPRE), 
kill _prowindows, 


restore (MPRE), 
t 
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recall2(MPRE) :- 
write list _b([’WARN...state’,MPRE,’cannot be loaded’]), 
writeln(’Issue ’’start.’’ command.’). 


war) Sequence :- 
show _parms, 
jolla 
writeln _b(’COMMANDS ‘), 
writeln(’go. begin execution’), 
writeln(’new(s). reset start’), 
writeln(’new(g). reset goal’), 
writeln(’store. save preprocessed map’), 
writeln(’recall. recall this map’), 
wWolteln("gtrace (xX). gGEapmies tracing: ’), 
writeln(’ 1 ALL algorithms’), 
writeln(’ d DISCRETE approximations’), 
writeln(’ i RELAXATION (iteration) ’), 
writeln(’ 0 trace OFF’), 
Woitelneb(" “! )y, 


show _parms :- % order is SIGNIFICANT 
w_showdata (time,0.0), 
olan ODE) 


w showdata(di,DI), 
deltak (DK), 

w_showdata (deltak,DK), 
t 


Siow parms :- !. 


PimsGc — Given s(s) and g(G), finds RS,RG regions containing them; 
algorithm is based upon fact that a convex region cannot have 

2 consecutive vertices whose heading difference from an 

arbitrary interior point exceeds pi radians (180 deg) 


s= dynamic 
ha/Z, %$ hd(v,h). heading from s/g to v is h 
start/2, Ss Start (p0, 60). Start and région containing it 
goal/2. S Goal(pl, rl). goal and region containing it 
eeeesg(X,P) :- 


retractall(hd(_,_)), 
find region(X,P,R), 
shorthand (X,XXXxX,_,_), 


OED = 3 (XXKX, > J 7 
retractall(OLD), 
NEW =.. [XXXX,P,R], 


asserta (NEW), 


set_sg_arcs(X), 
t 
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find region(X,P,R) :- 
rv (Rp We Vlok); 
fanocuc(l.vuS.)-, 
not (same (W,0)), 
shorthand (X,XXXX,_,_), 
wEeite: Tist ([XXXx, PB, wn, region | R}), 
{ 
find region (7, 2,4). 
write list b([{’ERROR (start) ...invalid@instance —’,P,) 1s 90 
writeln_b(’ inside obstacle, outside bender, sorion vertex. oF 


prowindows exists, 
t 


fanout (2 (v0 lViST)) 7 — 
get heading (P,Vv0,H0), 


fanfwd((V0,HO),P,V0,HO,VLST), 
t 


getoneading(a yn). 2=tnd( nH). $ return if already computed 
get heading(P,V,H) :- % else 
heading (P,V,H), % compute heading from P to V 


asserta(hd(V,H)), % cache result 
t 


fanfiwa( fVv0,HO) Pv Ht [le % close the circle 


delianh (Hi7HO, DH), 


! 
‘¢ 


DH s<5 13020; 
t 

fanftwa(VH;P,V1l,H1, ([V2ZIVEST]) :- 
get heading(P,V2,H2), 


deltah(H1,H2,DH), 


1 
ae 


Die 160.0, 


fanfwd(VH,P,V2,H2,VLST), 
| 


deltah(H1l,HZ,DH):- H@e> Hl, DH 1s H2-Hi, !. 
deltah(H1,H2,DH) :- DH is H2-H1+360.0, !. 
$ SCO COCO KOO ee ee Ca eee SS SS SS eS SS SS eS ee ee ee Se ee 


set somircc.~ | .= 
ret@eact old sg _arcs(X), 
Getspic (x, Be); 
re(Ryw,EG2ST), 
asserta (edge (X, [P,P], [(W,W],X,X)), 
asserta(edge data(xX,0.0,P)), 
asserta(er(X, ([R,R], (W,W])), 
gen_sg_ep(X,P,R,W, ELIST), 


EVAR ALLS T) ; 
gen_sg choke ep(X,P,R,W,VLST), 
straight line ep, 
! 
Seempog arcs(_) :- writelIn(’set sg arcs failed.’ )y !. 
Boeract old sg arcs(X) :- 


retractall(edge(X, , , ,_)), 
retractall(edge data(X, ,_)), 


retractall(er(X, ,_)), 
retractall(ep(X,_, _,_,_)), 
retractall(ep( ,X, _, , _)), 


! 
> @ 


Straight _line ep :- 
Stare(S,R), 
goal(G,R), 
re(R,W,_), 
wdistance(S,G,W,WD), 
asserta(ep(s,g,R,W,WD)), 
! 


Seraight line ep :- !. 


gen sg ep( ,_,_,_,l]). 

gen _ sg _ ep(X,P,R,W, [E|ELIST]) :- 
mertedge (Ei, 7, (170); 07.) )7 
edge data(E, _,MP), 
wdistance(P,MP,W,WD), 
asserta(ep(X,E,R,W,WD)), 
gen sg ep(X,P,R,W, ELIST) . 

gen sg ep(X,P,R,W, [_|ELIST]) :- 
gen sg ep(xX,P,R,W, ELiod). 


Gemusg choke ep( , ,_,_,[]). 

gen sg choke ep(xX,P,R,W, [VIVLST)]) :- 
chin (BG, V,_), 
wdistance(P,V,W,WD), 
asserta (ep(X,EC,R,W,WD)), 
gen_sg_choke_ep(X,P,R,W, VLST) . 

gen_sg choke ep(X,P,R,W, [VIVLST]) :- 
gen_sg_choke ep(X,P,R,W,VLST). 
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:- dynamic mse/1l. 


mse (sQ). % designate start point first by default 


use_module (library (dialog) ), 
use_module (library (interpret_messages) ), 
use_ module (library(messages) ). 


pixels (500) .% total number of map pixels in x and y directions 
map size(100) .% total number of map units in x and y directions 


map _item(@xcoord,text_item(’X: '’,0,none),below, [width: 4]). 
map _item(@ycoord,text_item(’Y: ’,0,none),below, [width: 4]). 
map item(@mstart, button(’ Start Pt’ ,m Stare cele ae 
map_item(@mgoal, button(’Goal Pt’,m_goal), below, []). 

map item(@mgo, button(’GO’, m go), below, []). 
map item(@mstore, button(’Store’,m store), below, [])- 

map _item(@mrecall, button(’Recall’,m_recall), below, []). 

map _item(@mpost, button(’Print’,m post), below, []). 
map_item(@mwinit, button(’W_Init’,m_w_init), below, []). 

map _item(@mnewmap, button(’New Map’,m_newmap), below, []). 
Map _item(@mkill, bueton(” Kill Mouse’ pm kit yee lou aie 
map_item(@msusp, button(’Suspend’,m_ suspend) ,below, []). 
map_item(@mhalt, button(’Quit’,m_quit), below, []). 


Calculate seine: = 
pixels (P), 
map size(C), 
G is P/C, 
IG is P//G; 
assert (pm _ratio(G)), 
ASSECEUN I pmeratio (16) ) 


exterminate :- 
destroy(@map_ dialog), 
destroy(@mstart), 
destroy(@mgoal), 
destroy (@mkill), 
destroy(@mgo), 
destroy(@mstore), 
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destroy (@mrecall), 
destroy (@mwinit), 
destroy (@xcoord), 
destroy (@ycoord), 


mouse :- 
exterminate, %$ exterminate old mouse stuff 
calewlate dim, 
send(@pic,smart,off), 
new _dialog(@map dialog,’Mouse Ctrl’,map item), 
send(@map_ dialog, open, point (510, 470)), 
qdliete oe 


Toop :- 
send (@pic, cursor _x,cascade(@xcoord, adjustx,0)), 
send (@pic, cursor _y,cascade(@ycoord,adjusty,0)), 
Sendi(@puce, left up, cascade (@pic, clicked, 0)); 
interpret_messages (fail). 


= 


eercked(PIC, ) :- 
mse (PQ), 
get re. (Gee, last click,PT), 
get (PT, x, XPIX), 
geelril,vy, 1 lA); 
Sonvertepe((APIX,YPExX], [X,1]), 
Seek wsg (POs Me ix, VOUx, (x, 21), 
| 


capeek og (sO, ([XAPIX,YPIX)], [X,Y]) :- 

set sg(s, CSF 
retractall(start( ,_)}), 
asserta(s([X,Y])), 
send(@s0,pen,1), 
send(@s0,center, point (XPIX, YPIX)), 
w_Showdata (start, [X,Y]), 

] 

ote. SO(g0, [XPIX, YPIX]), (X,Y¥]) :- 

SCC Sg (g, C.o2 abe 
Betractalliigoal( ; )), 
asserta(g((xX,7})), 
send(@g0,pen,2), 

send (@g0, center, point (XPIX, YPIX)), 
w showdata(goal, [X,Y]), 


ove 


ae 


oP lO 


= 


pass | 


m start(_,_) :- retractall(mse(_)), assertea(mse(s0))yaee 


m goal({_,_) :— réetractall(mse(_)), asserta (mse(qU) ee 
Mige (ly) =e ao. 

MEStOre(), oes eonrer 

m recalil(e,s) ese recamle 

mM POStt; 2) <= Wl Ppest. 

MWe (ye) = we 

m kill(_,_) :- exterminate, abort. 

m newmap({ ,_) :- start. 


m suspend(_,_) :- writeln(’Mouse suspended...hit “D to returney!)7 oro 
Mu) oe aes 


adjustx (XITEM,X) :- % display transformed x in dialog box 
pm_ratio(R), 
XX 1S 3410/7R, 
floor (XxX, Rx, 
send (@XITEM, selection, RX). 


adj usey (Yl ITEM) Yj % display transformed y in dialog @pen 
pM Eat 1 OR), 
map size(M), 
YY is (10*M) -Y*10/R, 
EVOGL (LY phy), 
send (@YITEM, selection, RY). 


CONVEErt pt CUEX, PY Ix ie 
pixels (W), 
pm_ratio(G), 

XX -1S°PX/G, 

YY is (W-PY)/G, 
round (xx, xc, 
round (YY, Y): 


convert pix([(X,Y]), [PX,PY]) :- 
pixels(W), 
PM rae (G), 
TPX is G*X, 
TPY is W-G*Y, 
TOUNG{TEX, PX), 
EFOUNGGIEY, PY). 
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= se cr rr rr rs cr cr cr a rr cr arr ar cr cs ars cr cr cr crs rs crs cr crs cr cr rr rr es a we oe ee 
le i Selle ee __ . _ _ 


:=- dynamic 
timer/0, $ time display for interactive runs w/o ProWindows 
ws Switch/0, 
wnos/0, % switch: display region weights 
EMWOs, 0, $ switch: display region index numbers 
enos/0, %$ switch: display edge index numbers 
detail d/0O, $ discrete point (udp) tracing switch 
detail i/0. % iteration (spr) tracing switch 
% 
wnos % default 
Tee ee ee 8 Se ee ee ee ee eee ee ee 
graphical tracing ON(1) / OFF(0) default = all OFF(0) 
ee ee Le oe Le eee eee eee eee x / 
Gece eractall (detail dj), retractall(detail 4). oer ee Switches 
gtrace :- gtrace(l). 
peace (1) 2> t set (detail d), t set (detail i). % both ON 
Gerace (1) -—- gtrace(0), t_set(detail i). Sheer aclon TON 
feeaee (Cd) ;- gtrace(0), t set (detail d). % discrete ON 
gtrace(Q) :- =A oleae (6) 22 
retractall (detail d), 
Beeracedhidebartl 1), 
destroy (@iter). 
msec (D) 3- 
prowindows exists, 
retractall(D), 
assene (e), 
warn(Q), 
create iter, 
warn(1). 
eet ( ) s- 
writeln(’CANNOT trace graphics...ProWindows NOT running.’), 
fail. 
create iter :- new(@iter,figure(0,0,0)), send(@pic,display,@iter). 
eacare alter. % already exists 


pibes) 


warn(1) :- prowindows exists, send(@sys,warnings,on). 


warn(0) :- prowindows_exists, send(@sys,warnings,off) . 

Wael. 

Start prow lndows —:= $ attempt to start prowindows 
prowindows, nl, 
Wal mit, 
We 

start prowindows := % prowindows CANNOT be started 


writeln(user,’NOTE...All screen output will be textual.’), nl, 
t 


Wont. = 
kill prowindows, 
prowindows, 
mapname (MN), 
grey bitmap, 
black_bitmap, 
display map(MN,@pic), 
showtitle, 
Wo 2Inatdbis, 
reestablish detail status, 
create _sg(s0), 
create _sg(gQ0), 
w_showsg(s), 
w_ sShowsg(qg), 
w_initparms, 


% new(@path,path), % used when erasing and replacing paths 
mouse, 
ee 

Wo awe te % ProWindows warns if it cannot start 


Create Ssaq(ein 
shorthand(_,_,CIR,TH), 
new(@CIR,circle), 
send(@CIR,radius,5), 
send(@CIR,pen,TH), 
inteaalepiace (CIR), 
send(@pic,display,@CIR). 


initial place(s0) :- send(@s0,center, point (425,565)). 
initial place(g0) :- send(@g0, center, point (425,585)). 


reestablish detail status :- 
( deta d: 4edetaa iwi), 
new (@iter, figure(0,0,0)), 
send(@pic,display,@iter), 
1 


reestabPrsnecdetad teseakUs. j— ))] 
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w_Showsg(SG) :- 
prowindows exists, 
get p r(SG,P,_), 
shore nana (sG, STRING, CIR, TH), 
convert pix(P, [XPIX, YPIX]}), 
send (@CIR, pen, TH), 
send (@CIR, center, point (XPIX, YPIX)), 
w_Showdata(STRING,P), 
t 

w_showsg(SG) :- 
geteper(oG,P,.), 
shorthand (SG, XXXX,_,_), 
write list ([XXXX,'’=',P]), 
t 

w_showsg(SG) :- 
shorthand (SG, XXXX,_,_), 


write list b([‘’NO’,XXXX,’point established.’ ]), 
t 


ome 6r(S,P,R) :- Start (P,R), !. 
wereommrig,F,R) :- goal({P,R), !. 


Smorchnand(s,start,s0,1). 
smerthand(g,goal, g0,2). 


weoin(P) :- teUseacto highlignt a point X,Y 
prowindows exists, 
DEeLranoLorn(r .~(SxX,SY)), 
Mie is (SXt12; %$ diagonal arrow 
Yeleus GY=12, 
new (@P,circle(X1,Y1,5)), 
send (@P,pen, 4), 
send(@pic,display,@P), 
new (@L, line (X1,Y1,SX,SY)), 
send(@pic,display,@L), 
t 


meme) <= write list ([’WARNING...pin point placed on’,P]), !. 


wW point (P,RADIUS) :- % used to highlight a point X,Y 
prowindows exists, 
Becanetorm (2, (5%, 5% ) ); 
new (@PT, circle (SX,SY,RADIUS) ), 


% send(@PT, fill, @black), seoption to.til] 
send(@PT,pen,5), % option to thicken 
send(@pic,display,@PT), 

% BxXteiss RADIUS+Z, % option to extend crosshairs 

% CzoOcsnarrs (SX, SY],EXT), % option for crosshairs 


wmeotine{ ,.)s:- !. 
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Crosshairs ((SxX7o Vl, on!) 

XM? as7SAtExA1, 

X2 1S “SX=EXT, 

Yl is SY+EXT, 

Y2 1s SY -EXT, 

new (@LH, Line (Xl, SY, X2,o07 
new (@LV, line (SX, Y1,SX,Y2)), 
send (@pic, display, @LH), 


send(@pic, display, @LV), 
1 


Weecge (2) s.— 
prowindows exists, 
edge _data(E,_,MP), 
ptransform(MP, [SX,SY]), 
new (@RING, circle (SX, SY,9)), 
send(@pic, display, @RING), 
t 


WlEdGe a 


we lear we ee 
(detail d ; detail_i), 
send(@iter,destroy), 
new (@iter, figure(0,0,0)), 
send(@pic, display, @iter), 
' 


wo clear iter 32)! . 


w show _iter(PATH,TH) :- 
detail i, 
new(@ITER, path), 
append points (0,@ITER, PATH), 
send (@ITER,pen,TH), 
send (@iter, append, @ITER), 
{ 


w_ show_iter(_, _) :- !. 


w_ show_line(P1,P2,TH) :- 
detail d, 
ptransform(P1, (SX1,SY1]}), 
ptbancrorm (2, (SXZ, 512), 
new (@L, line (SX1,SY1,SX2,SY2)), 
send(@L,pen,TH), 
send(@iter, append, @L), 
t 


WwW SHOWS, 


WwW Showpatmh (EAT): = 
prowindows exists, 


D352 


% crosshairs 


highlight an edge E 


destroy(@path), % used when eraSing and replacing paths 
@isplay path (@patin, PATH, Chic, 2), 

% display path(@P,PATH,@pic,3), 
t 


wmsnowpath(.) :- !. 


w Showdata(CAT,DATA) :- 
prowindows exists, 
GOGE(CAT 0, Uy, 
spacing(S), 
XD is X+S, 
type_convert (DATA, SDATA) , 
destroy (@CAT), 
new (@CAT, text (SDATA, XD, Y, left)), 
send (@CAT, font, font (screen,b,14)), 
send(@pic, display, @CAT), 
t 


w_Showdata(time,DATA) :- screen _timer(DATA), !. 

Mashowdata(pacost, ) :- !. 6 displayed by sa.pl 
w_Showdata(CAT,DATA) :- write list([CAT,’=',DATA]), ! 

screen timer(DATA) :- timer, writeln(DATA), backup, !. 


screen timer(_) :- !. 


meyee convert (DATA, SDATA) :- 
Soest (DATA), 
concat_atom(DATA,’,’,SDATA), 
t 


type convert (DATA,SDATA) :- make string(DATA,SDATA), !. 


ews LT 1 te 3 — 
prowindows exists, 
w_clear ws, 
new(@ws2Z,path), 
t 


Wmvsinit :- !, 


w clear ws :- 
prowindows exists, 
retractall(ws_ switch), 
destroy(@wsl), 
destroy (@ws2), 
t 


meclear wS :- !. 


destroy(OBJ) :- object(OBJ), send(OBJ,destroy), !. 
Seat Eoy( ) ;- !. 


2a5 


w_ show _ws(L) :- 
prowindows exists, 
get_midpts(L, LM), 
Swap _wsS(LM), 

t 


Ww SNOW WS(2 eS ol 


get _ midpts( (1). 
get_midpts({E/[LE], [MiILM]) :- 
edge_data(E, _,M), 
get_midpts (LE, LM), 

t 


Swap ws(LM) :- retract (ws switch), w_ws(@wsl,@ws2,LM), !. 
Swap ws(LM) :- assert(ws_switch), w_ws(@ws2,@wsl,LM), !. 


w_ws(@WS1,@WS2,LM) :- 
new(@WS2,path), 
append points (0,@WS2, LM), 
send (@WS2,pen,2), 
% send(@WS2,smooth,on), %$ smoothing option 
send (@WS1,destroy), 
send (@pic,display,@WS2), 


{ 
. e 


APPENGEPoInMeSs eile oe 

append peoints({SwWPCPATh, | ie, (a,b) tie $ discrete paths 
ptransform( {X,Y ie 2), 
new (@PT,point (IX,I1Y)), 
send (@PATH, append, @PT), 
turn_mark (SW, {IX,IY]), 
append points (SW, @PATH,L), 
t 

append points (SW,G@PATH, (ei) ) 3- 
ptrranstorm( Ph, ix, 1Y)), 
new (@PT, point (ix, LY) ji, 
send (@PATH, append, @PT), 
turn_mark (SW, (IX, IY]), % SW=1, mark turns by ‘+t’ 
append points(SW,@PATH,L), 
t 


oe 


SW=1,emarketurns bye 


Lunn make ee ||) es 
TRILY as Yel, % correct text center 
new (@TXT, text (‘+'’, IX,  TXTIY, center)), %$ turn marks are ‘+’ 
send (@TXT, font, font (screen,b,12)), 
send (@pic,display,@TXT), 
t 


operate lela) < 10) ni) ese ee 
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w_ post 


= TOW INdOWs CX1SES,. WwW pOost4ss!) . 


WmPOsSt (PRT) :- 


ae 


prowindows exists, 

send (@pic, postscript,pspicfile), 
Senasco (ERT); 

unix(system(’rm pspicfile’)), 
COne@ateondce(” 1pq —P") PR1,QPRT), 
unix(system(QPRT)). 


w post( ). 


Bena tO(SSl) :- unix(system(’lpx -Pssl pspicfile’)). 
eemaeto (up!) == unax(system(’ lpx -Pupl pspicftile’)). 
send to(up2) :- unix(system(’lpr -Pup2 pspicfile’)). 
send to(secs) :- unix(system(’lpr -Psecs pspicfile’)). 
Sena, tOo(phd) :- unix(system(’lpxr -Pphd pspicfile’)). 


display map(MAP,PIC) :- 


ticks 


algorithm type(ALG), % 
name (ALG, NALG), 

name(’ - ',NSPC), 

name (MAP,NMAP), 

append (NALG,NSPC,NLBL1), 

append (NLBL1,NMAP,NLBL2), 

name (LABEL,NLBL2), 

new (PIC, picture (LABEL, size(500,700))), 
send (Pie, horizontal serollbar,0), 

send (PIC,vertical scrollbar,0), 

send (PIC, open, point (620,70)), 

ticks, 

new(@map, figure(0,0,0)), 

send (@map,can_move,off), 

append edges (@map), 
send(PIC,display, @map), 


fHiPwoestacles, 
t 


meaexs (00,0). 
verers (0100), 
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set in make file 


xtacks (X,Y) := 
x=) .0, 
xCranstonn(s, 1x), 
Veranstcoum(y, 1), 
new (@TXT, text (" |’, TX, TY,center) ), 
send (@TXT, font, Eont (coun, b,10)), 
send(@pic, display, @TXT), 
X2°4S5-X%=10;, 
xeicks (X2, YY); 
t 


XtiCks (72) da0e 


yticks (X,Y) :- 
Y >= 0, 
XE ransftorm(s, 1), 
yeEranstorm(y, Loe 
new(@TXT, text (’-’, TX, TY,center)), 
send(@TXT, font, £ont (cour, bb, 15) )- 
send(@pic, display, @TXT), 
YZ SLSey—1 0 
Vileks (%,Y2), 
t 


VEICKS (a) shag ee ee 


append edges (GRIGG) =: = 

edge (E, (Vig V2) , (W1,W2] r_r_) ’ 
% not (same (W1,W2)), % phantom edges not displayed 
not (same (E,SsS)), 
not (same(E,g)), 
madpoingivl,V2, Me), 
ptranstorm(Vi, ([PxX1,PY1]), 
ptranstorm(vZ, (—xz2,PY2)),; 
ptransform(MP, [PXM,PYM]), 
new (@LIN, line (PX1,PY1,PX2,PY2)), 
send(@LIN, arrows, first), 
send(@FIG, append, @LIN), 
enos, 
new (@TXT, text (E, PXM, PYM, center)), 
send (@T xt) tone, one (Cour, b>, 0) >, 
send(@pic,display,@TXT), 
fan 
append edges()):— ( enos ; req@aconm bls) ) aw 


oo 
oe 


visual check edge consistency 


regione bls. 
rv (RW, VlLSl), 
not (same (W, 0)) ’ 
avgGnvismdyiot, v0); 
Ptransftorm(vo, (Px, PY)}, 
get region l1bl(R,W,L), 
new (@RWT, text (L,PX,PY,center)), 
Send (@RWl, ont, .ont (cour, b, 10) 
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send (@pic, display, @RWT), 
fail. 
Begronolpls = ! . 


Feeered lon elol(R, Rk) .- 8nOs,. 
gee region Ibl(_,W,W) :=- wnos, !. 
moSs{N) :- 


retractall(enos), 
retractall(rnos), 
retractall(wnos), 


( N == e -> assert (enos) 
{| N == r -> assert (rnos) 
| N == w -> assert(wnos) ). 


awaevist (VLST, [X,Y]) :- 
accum vist (ViS7T, (1X, 1Y]), 
tengen(VisTl, lL), 
Mois. TA/ LL. 


MiSs TY/L- 
{ 


meen Vist((],[90.0,0.0]) :- !. 

eieoum vVist([[xX, Y] |VLST], (XCM, YCM]) :- 
accum_vlst (VLST, [XSB, YSB]), 
XCM is XSBtX, 


reMeias YoBry, 
t 


fimoplay path(@PATH,L,PIC,TH) :- Ge a el YL. ee eye een; Vv 
new (@PATH, path), 
append points(0,@PATH,L), 

% append points(1,@PATH,L), 
send(@PATH, pen,TH), 6 TH = thickness in pixels (1 default) 


send(PIC, display, @PATH), 
t 


menanstorm( (X,Y), (SX,SY]) :- 
xtransform(X,SX), 


VeTansrorm{y, SY), 
' 


xtransform(X, IX) :- 
XX is X*5, 
round (XX, IX), 
t 


Pecans kOrm(y, 11) 9 >— 
WY tam POO —y) <5, 


BOUnatyY Y, LY), 
t 


251, 


grey bitmap :- 
new (@PATTERN, bitmap (2,2)), 
send list (@PATTERN, set, |[point(0,0)),pount(), 1) jae 
new (@grey, bitmap (64, 64)), 
send (@grey, replicate, @PATTERN) . 


black {batmap es. 
new (@PATTERN, bitmap (2,2)), 
send list (@PATTERN, set, 
[point (0,0) ,point (0, 1), point (170)) porn pe 
new (@black, bitmap (64, 64)), 
send (@black, replicate, @PATTERN) . 


% send_list (@PATTERN, set, []), % what white would look like 


w initibis <= 
code (CAT, LABEL,X,Y), 
new (@LBL, text (LABEL, X,Y,left)), 
new (CCAT,text:(" 70,0, leEt)), 
send(@LBL, font, font (screen,b,14)), 
send(@pic,display,@LBL), 
fail. 

Wlaimat tbls Sai 


decode (TERM, SDATA, CAT, XD,Y) :- 
TERM =a, (CAL, DATA, 
make string(DATA, SDATA), 
code (Car mye, 1), 
spacing (S), 


XD is X+S, 
i 


make string(DATA,STRING) :- 
number (DATA), 
number chars(DATA,CLIST), 
atom chars (STRING, CLIST), 
make string (DATA, STRING) a 
atom(DATA), 
hame (DATA,CLIST), 
avemeecnars(oTRING, Chis l); 
make_string(DATA,_) :- 
var(DATA), 
writeln(’ERROR (pwin)...cannot make string from variable’), 
i 
make string(DATA, _) :- 


write list({’ERROR (pwin)...unknown data type:’,DATA)), 
t 
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Goncatenate (S1,S2,53) :- 
name (S1,1L1), 
name (S2,1L2), 
append (L1,1L2,1L3), 


name (S$3,1L3), 
! 


showtitle :- 
mapname (MN), 
algorithm type (ALG), 
concatenate (ALG,’ - ’,TITLE1), 
concatenate (TITLE1,MN, TITLE), 
new (@ttl,text (TITLE, 250,530,center)), 
send (@ttl, font, font (screen,b,16)), 
send(@pic,display, @ttl), 
new (@datestmp,text(’ ',250,660,center)), 
send (@datestmp, font, font (screen,b,14)), 
send(@pic, display, @datestmp), 
! 


soacing (150). 

code (pacost, ‘best path ...... ali 2 oO.0 
Bege ~elcost, ‘ellipse cost ... ’, 10,580). 
mocge(di, ’discrete int ... °°, 10,600). 
code(deltak, ‘delta k ........ O62 Oye. 
Bede(start, ‘start point .... ’, 260,560). 
eoce(goal, ‘goal point ..... 7 -2O0pSCU). 
Sede ({blanki, ’ °’, 260,600). 

code(time, ‘'cpu time used .. ', 260,620). 


update clock (NEWTIME) :- 
tm(ETIME), 
retract (time(TIME)), 
NEWTIME is TIME+ETIME, 
assert (time (NEWTIME)), 
w showdata (time, NEWTIME), 


ei; 
! 


weit parms :— 
retractall(time(_)), 
asserta(time(0.0)), 
w_showdata(time,0.0), 
ean), 
w_showdata(di,DI), 
deltak (DK), 
w_showdata (deltak,DK), 
! 


Weemitparms ;— }). 


oy) 


ads :- date@etramp (x), dszix), !. 


dsi(®) ae 
prowindows_exists, 
send (@datestmp, string, X), 
fil, !. 
dis®(X) sae 
alqorithm_type (ALG), 


nd, 

writeln (’ ‘yy 
write(ALG), $ algorithm id 
emeiteds? “), 

writeln(X), % time stamp 


t 
eo ¢ 


datestamp(K) :- 
sys (/date>date’), 
open(date, read,S), 
see(s), 
fi llersering(NLIST), 
name (X, NLIST), 
seen, 
sys(‘'rm date’), 


- 


fill gtmimee (Cheb ISa@)) ae 
get0 (Cc), 
Ret (1 MveheGale (C)), 
fill stminqe¢NLIsST), 


fill sweing((}]) :- !. 


fill obeweci¢s :- 
rv(R,0, [VIVLST]), 
not (border (R)), 
&ppend( (VLMLST), (V), VL), 
fil 1 padi (Vi)y 
fail. 
fill obgtacdmge:- ‘-. 


fill poly(VL) :- 
new (@POLY,path), 
append points (0, @POLY,VL), 
send (@POLY, fill, @qrey), 


send (@pic, display, @POLY), 
, 
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B.S) UNIFORM-DISCRETE-POINT GLOBAL A* (UDPGA*) SEARCH 


UDPGA.PL - Uniform-Discrete-Point Global A* (UDPGA*) Search 
Approximates the globally optimal path by using A* search 
on the graph of evenly spaced points on each boundary edge, 
connected by arcs (segments) through common cost regions. 
Parameter di(I) is the upper bound for point to point spacing. 
uses HEAP in C to maintain agenda 


a 
/ *saeeeeas555555555552=522282255555S SSeS RS See S Seer esses SSS eS SeSeSSS5== 
A* SEARCH 
adapted from Rowe, N.C., 
"Artificial Intelligence Through Prolog," 
Prentice Hall, 1988, pp. 244-247. 
For an application, define 5 predicates: 
(a) successor (State, Newstate) (gives state transitions) 
(b) goalreached (State) (defines when goal achieved) 
(c) eval (State, Evaluation) (estimates cost to the goal) 
(Qymecost(statelist, Cost) (computes cost of a path) 


(e) search: top-level predicate that initializes things, 
then calls astarsearch with two arguments, the starting 
state and variable which will be the solution path 


Note that "cost" must be nonnegative. The "eval" should be a lower 
bound on cost in order for the first answer found to be guaranteed 
optimal, but the right answer will be reached eventually otherwise. 


At conclusion of processing: 
no. of items in agenda - 1 = no. of unexamined states 
no. of items in usedstate = no. examined states 


Modifications to original code: 


In this version, we modified cost to cost (Statelist,OldCost,NewCost) 
to reduce the work required to compute the cost of a new statelist. 
Also, we have replaced pick_best_path rules with a more efficient 
version which maintains heap to find the minimum cost+eval on agenda 
more efficiently. Since heaps are not efficient in Prolog, the heap 
routines have been coded in C. 


The original code referenced in [Rowe88, pp. 244-247] states that if 


the evaluation function is ALWAYS a lower bound on the cost function, 
then faster performance results if we delete the first rule of 
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agenda_check and usedstate check, and the entire definitions of 

fix agenda and replace front. We have determined that the first seuss 
of agenda_check IS REQUIRED to guarantee optimality in a general 
graph (ie. NOT a tree). Therefore, we have NOT excluded it. Since 
our evaluation function is Euclidean distance to the goal at lowest 
cost on the map, then it is a lower bound on cost. 

We have, therefore, modified the original code accordingly. 


ed 
eee 


[= dynamac 
edge_pt/2, %$ edge _pt(e,[x,y]). 
usedstate/2, % usedstate([(e, (x,y]], cost). 
agenda/5, % agenda(i, [e, {x,y]], [{fe,{x,y]],..],cost,eval+cost) . 


% dynamic: crude and refined versions 
successor/2, 


goalreached/1, 

eval/2, 

COSt/ 3, % cost (state, oldcost,newcost). 

tame/l, %$ time(t). 

day, $ overrides udp.pl 

deltak/1, %$ used for compatibility w/ pwin.pl, start.pl 

solution/4. $ solution(ws,path,cost,time). 
Girls). + default setting 
deltak(0.0). $ for compatibilty (NOT used in this algorithm) 


cleangocs “5 
Felt raGea bi(euceessor (ln) ), 
retractall(goalreached( )), 
retractall(eval(,_)), 
retractaldl (cect, 2) ); 


Crude search through midpoints in order to compute bounding ellipse 
NOTE: successor, goalreached, cost, and eval fns CANNOT have cuts ! 


set Crudesoesa.- 

eleéanJ0ps, 

asserta ( ( 
successor(E0,E1) :- 
( ep(E0,El, , ,_) , ep(B1,E0, , ,_) ) 
), 

asserta(( goalreached(g) )), 

asserta ( ( 
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eval(E0,EVAL) :- 
goal(GP, jr, 
edge_data(E0,_,MP), 
distance (MP, GP, EVAL) 
ie 

asserta ( ( 
eose4 (50,61) ),OLDCOsT, Cost) :- 
(wen (EO, f i, 7270)? ep(El{ £0, 2, Cis 
GOST 18) CrOLDCOsST 
)), 

aSSenrtawy cost ((S),.,0-0).)), 


Sem refined ops :- 
clean ops, 
asserta ( ( 
successor([{E0,P0], [E1,P1]) :- 
( ep(E0,E1, , ,_) ; ep(E1,E0,_,_,_) 
; refl_edge(E0,El1) ), 


Gr rertlecticon 


edge pt(E1,P1), $ Pl must be a point on EO 


not (same (P0,P1) ) % same points = 


ye 
asserta(( goalreached([g,_]) )), 
asserta ( ( 


=> no progress 


eval([_,POJ,EVAL) :- % Eucl dist to goal at coef = l 


goaliGP, ), 
optimal cost (W), 
wdistance (P0,GP,W, EVAL) 
yd, 
aoserea(( cost ((50,51|_ ],0C,C) :- reost (S0,51,0C,C) 


aosemea(( (cose (((s, 03), .,0.-9) )), 
t 


Berd edge(E0,E0) :- not (edge(E0, ,(W,W],_,_)). 


meesti( (60,P0)], {[E0,P1)],OLDCOST,COST) :- 
edge(E0, _, (WO, _] r_7_) ’ 
wdistance(P0,P1,W0,C), 
COsiets OLDCOST + C. 

Beose (({hO,r 0), (h1,F1),OLDCOST, COST) :- 
( ep(E0,E1,_,W,_) , ep(E1,E0, ,W,_) ), 
wdistance(P0,P1,W,C), 
CO- leis OLDECOST, +. C- 
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dd, 


Geral poimtsu = % also generates records for ‘Syandma 
edge (E,V, [_, W) ee ' 
not (same (W,0)), 
get_pts(E,V,PLST), 
Maken recor as (se, elon), 
bs Wo Us lee 
Genga he pOants ise 


make records (a, (i. 

make records (EB, [(*%, Viiemet)) <= 
asserta(edge_pt(E, [X,Y])), % ensures hashing on E edge no. 
make records (E,PLST), 


/* ss eo oOo oe eS ee 
search driver 
ee a ee ee eee ee eee * / 
search #7— 
w_initparms, % display initial parameters 
unknown (_,fail), %$ required by astarsearch 
LeSecuepaanus, %$ reset epts and edge-pt for udp.pl 
set_crude_ ops, 
writeln(’Stage 1: Crude A**search (init solution) 273" 
iS, 
astarsearch(s,WS,_), 
writeln(WS), 
optimize ws (WS, CrudePath, UCost, SCost), 
write. list([{" Crude path costs UDP =',UCost,” (SPR = | sCGoscile 
update clock (Th), 
Writeelist ([@eime —", 01)'), 
w_Showpath (CrudePath), 
avg_path_wt (SCost,CrudePath, APW), 
% asserta(optimal cost (APW)), t heuristic ellipse 
write list([’Average Weight =’,APW)), 
tm, 


ellipse (SCost), 

Upddtemelock(TZ), 

Wot oust Gl tame ne |); 

writeln(’Stage 2: Refined A* search (UDPGA*)...’), 
set refined ops, 

Gena aPpolnt S;, 

StCaAEntU (SP, =); 
astarsearch((s,SP),StateList,ACost), 
woiteblast (f° A* search, path cost = 7Aeost|); 
Scpatate(Statehist,.Ans, =), 

writeln(AWS), 
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writeln(’Check WS for inconsistencies...’), 

fix ws(AWS,Fixedws), 

writeln(Fixedws), 

optimize ws (FixedWS, SolutionPath, UOCost,OptCost), 
write list([(’Optimal Path costs UDP =’,UOCost]), 
WEitewlast ({° 9 SPR =" ,OptCost]), 

bpdaremelock(13) 7 nl, 

% Cleanup and Housekeeping 
unknown (_,trace), % reset after asStarsearch 
w_showpath(SolutionPath), 
w_showdata (pacost, OptCost), 

Wetreonlast<( |’ UDPGA~ Optimal cost =’ ,OptCost]), 

write list([(’Finish time =’,T3]), 

asserta (solution (FixedwS, SolutionPath, OptCost,T3)), 

notrace, % in case trace was on 
t 


Peace. —- weiteln O(’RERROR (aStar)...A* search failed !"), !. 


optimize ws(WS,PATH,C,COST) :- 
writeln(’ UDP..." ),; 
drakstra(is,2,C) , 
wreaitelnd SPR... 229s, 
solve (WS,P,PATH,COST), 


—_——— = ame ame eee oe ome ome oe ome coe cme cme cee oe oe oe oo om oom oo ee ee ee oe om oe oom oe oe ee om oe om me cee = cm ee oe ew ee ee ee ee ee ee oe oe oe em om cee ee oe ee oe ee om om ome ame ee ae ee ee ae oe 


separate((],[(],(]) :- !. 
separate([(({E,P]|SL), (EIWS], [P|PA]) :- separate(SL,WS,PA), !. 


fix ws(({S|WS],CW) :- 
correct _ws(S,WS,WS0O), 


remove bad reentrant([S|WS0],CW), 
t 


eeerect WS(E0, [ET], (E1)) <== % end of ws 
(ep(E1,E0,R,_,_) ; ep(E0,E1,R,_,_)), 
t 


correct ws(El, (E1,E1|WS),CW) :- % unnecessary El 
eerrece ws (Eh, (b1|WS1,CW), 
t 

eomrect wS{E0, (H1,EZ2|WS),CW) :- % unnecessary El 
(ep(E0,E1,R, _, _) 7 ep(BE1l,E0,R,_,_)), 
(ep (El, E2phpey) ; ep(hZ, al, Ry 2am) dy 
correct _ws(E0, [E2|WS],CW), 
{ 

Socrect wS(_,([E1,E2|WS)], (E1|CW]) :- % OK, continue 
correct_ws (El, [E2|WS],CW), 
t 

Correct ws(E,WS,CW) ;:- 
Wiebe lio (ERROR w(astdiye.. tdi lead urowri xe Wom) 
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Wreicelngocay, 
writeln b(WS), 


writeln_b(CW), 
! 


remove_bad_ reentrant ([E0], [(E0]) :- !. 
remove _bad reentrant (f{E1,E0],[E1,E0]) :- !. 
remove bad reentrant ({E1,E2,E2,E3|WS],2) :- 


( ep(Elya2, Ri Wi, -))); ep(a2, fl, Ri, Wie, 

( ep(E2Z,E3,R3,W3,_) 7? Ep(E3,52,R37W3,0)9), 

( not (same (R1,R3)) -> Z=[E1,E2|CW] $ continuous 

| edge (E2, _,[{_,W3],_,_) -> Z=[El, E2, E2|CW] % OK 
otherwise -> Z=[E1|CW] ), % remove 


remove_bad_ reentrant ([E3|WS],CW), 
t 

FeMmove bad preenc ramet) Bis Wod ate ew) ae % OK, continue 
remove bad reentrant (WS,CW), 


astarsearch(Start,Goalpathlist,C) :- 
cleandatabase, 
add state(Start,[{],0.0), 
repeatifagenda, $ iterative loop 
pick best state(I, State, Pathlist, Gc), 
add Successors (1, State, baum st, C),, 


agenda(I,State,Goalpathlist,C, ), %$ soln at top of agenda 
t 


pick best stabe(l, State, Pathiist,C) :— 
del_min(I), % delete top of@iea: 


agenda (I,State,Pathlist,C,_), %. retracteim add suee 
! 


% add_successors succeeds only when best state on agenda includes goal 


add successors( ,State, ,_) :- goalreached(State), !. 

add succeecors (7, State, Patniist, Cc)  := % fail, add successors 
successor (State,Newstate), 
proper (Newstate, Pathlist), 
add_state (Newstate, Pathlist,C), 


fail. 

add sucéessous(l ctate,,C)=:- % remove cur state, fail 
PGtpacrqagenda(l, 5.7.07.) 19 %$ pick_best (top heap) 
asserta(usedstate(State,C)), 
fail. 

proper ([E0,PR2), [{E0,PR1], [E1,P1]!_]) :- % reflection ? 


! % fail rule if head match 


a 


er(E0,R0, (WO, ] ) c 
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Dye (USE ikea 
maeen 1 ( KO; RL), 

edge (E0,_,(WO, J, _,_), % reflective side of edge ? 
SCemeiotyh t,eRt, D1), 

Sqr udist(Pl,PR2,D2), 

D2 > Dic % reasonable reflection ? 
! 


oP 


Iwemer( ,_) :- !. no match to rule 1 head ==> no reflection, succeed 
moechori (Rh, 2), |. ,R] ae !. 
maeen r{(R,.),(R,.)) :- !. 
meechie rt | ,R},[.,R)) := ¢. 
neeen ri [7K], (R,;_]) <= !. 


add_state(Newstate,Pathlist,C) :- 


cost ((Newstate|Pathlist],C,Cnew), 


1 
oy 4 


agenda_check (Newstate,Cnew) , % fail if on agenda 


! 
°f 


usedstate check (Newstate, Pathlist,Cnew), % fail if seen before 
t 


of 
eval (Newstate,Enew), 
D is Enew + Cnew, 
ins _heap(D,I), 
asserta (agenda (I,Newstate, [Newstate|Pathlist],Cnew,D)), 
Bpeadt omc OCKk (1); 
display newstate (Newstate,Pathlist), 
Emm, 
ies 
e@eaustate (Newstate,Pathlist,C) :- 
not (cost ({[Newstate|Pathlist],C,_)), 
write list b([*BRROR (astar)...cost fail’, [Newstate!Pathlist]]), 
t 
weeesctate (Newstate,Pathlist, ) :- 
moeleval(Newstate, _)), 
WEetee last b(( ERROR (astar)..-eval fail’, [Newstate|Pathlist]]), 
t 


FOR DISPLAY DEBUG ON VT-100 WITHOUT PROWINDOWS 
Peep lavencwocaccwim, £0), (( ,Pl}{2)) :> write list ([P1,’-=>',P0)). 
@rsplay newstate([s,_],[]).- 


oP oP ol? 


eeoplay newstate([ ,P0],([[_,P1)|_)) :- % refined DISPLAY 


Woclowmeline (Pl, PO, 2), 
! 


EEsplay mewstate((s,.],[]) :- !. % ignore refined start 
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display inewsStare(e0, (El)|ii a. — % crude DISPLAY 
edge _data(E0, ,MPO), 
edge_data(El,_,MP1), 
w_show_line (MP0,MP1,2), 
t 


display newstate (7 (le: % ignore crude start 


agenda _ check - check for state S already on agenda; 
linear search for S which has greater cost back to start; 
remove and replace with shorter route; 
linear search to delete from heap; 


a ee ee eee x / 
agendavenech (5, ¢)an.— 

agenda (I,S,_,C2,_), 

CeC2; 

Eetract agenda tan; iy aaa 

del heap(1), 

t 
agenda cheek (S,-) “== agenda(;s,eym7e ee 7 wea 
agenda check( ,_).% else, if not on agenda, succeed and put on 
usedstate weheck (5,5, ) :> usedstare (87) | ja taan 
usedstate checha@,, |). 
repeatifagenda. % repeat while agenda NOT empty 
repeatifagenda :- agenda( , , , ,_), repeatifagenda. 
cleandatabase :- 

retractall(agenda( , , , , )), 


retractall(usedstate( , )), 
init heapt])= 
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B.6 MAP MAKER 


MAPMAKER.PL - mouse assisted weighted-region problem map making tool; 
create/edit simple line maps for the weighted region problem; 
capture screen points, convert to map coordinates, and store 
as edge predicates; requires special version of ProWindows 
created with particular libraries from Quintus ProWindows. 


itebary directory (' /usr/local/quintus/generic/qplib2.5/library’ ). 
library directory (’/usr/local/quintus/pwl.1/library’). 
make :- save(mm,1), go. 
make :- writeln(’Created executable: mm’), halt. 
pixels (700). % number pixels in one dimension 
map size(100). $ number map units in one dimension 
i avnamic 

weights/1, 

point, 1, 

pm_ratio/1, 

pometed G17 1), 

pix edge/S. 
Beachts({1,1]). %$ initial default weight setting 
Go. :- 

kill prowindows, 

Eetractali(pix edge( ,_,_+_+_))+ 

precalc, 

make map. 
fie ;— kill prowindows. 

use _module(library (basics) ), 

use module (library (dialog) ), 

use module (library (interpret_messages) ), 

use_module (library (messages) ), 

use module (library(strings) ), 

use module (library (math) ). 
writeln(X) := write(X), nl, !. 
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midpoint ([X1,Y1], [X2,Y2], [XM,YM]) :- 
XM is 0.5*(X1+X2), 
YM is 0.5*(Y1+¥2), 


map item(@xcoord,text_item(’X: ',0,none),below, [width: 4]). 

map _item(@ycoord,text_item(’Y: ’,0,none),below, [width: 4]). 
map_item(@new_line,button(’New Ln’, cascade (@pic,new_line,0)),below, []). 
map item(@mclear, button(’Clear’, mmclear), below, []). 

map item(@wtl,text_item(’W1l: ’,1,cascade(@pic, set1,0)),below, [width:2]). 
map _item(@wt2,text_item(’W2: ’,1,cascade(@pic, set2,0)),below, [width:2]). 


map item(@blankl, label(’’,0),below, []). 


map item(@lfile,text_item(’Load:’,map, cascade (@pic, stay,0)), 
below, [width: 8]). 
map item(@mload, button(’Load’, mmload), below, []). 


map item(@blank2, label (’’,0),below, []). 


map _item(@sfile,text_item(’Save:’,map,cascade(@pic,stay,0)), 
below, [width: 8]). 
map _item(@msave, button(’Save’, mmsave), below, []). 


map item(@blank?, label (’’,0),below, []). 

map item(@mprint, button(’ Print’, mmprint)),, bellew, | je 
map item(@blank4, label (’’,0),below, []). 

Map item(@mquit, button (’ Quit’, muquit), below, ()). 


stay( ;S)iiee 
send (@sfile, advance,none), 
send (@lfile, advance,none). 


setl(_,STRW1) :- 
name (STRW1,L), 
number chars(W1,L), 
retract (weights([_,W2])), 
assert (weights ([W1,W2])), 
send (@wtl1, advance,next). 


SEC2Z( 0, Oo SRNZ) oe 
name (STRW2,L), 
giolilerasa (clevetetsy (nis lel), 
retract (weights([W1,_ ])), 
assert (weights([W1,W2])), 
send (@wt2, advance, previous). 
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ticks :- 
pixels (W), 
Pars W// 10, 
WO is W-T, 
ticks2(Ww0,T), 
t 


ereks2(X,T) <= 
X >= 1, 
new (@TXT, text ('|',X,0,center)), 
send(@TXT, font, font (screen,r,12)), 
send(@pic,display, @TXT), 
X2 is X-T, 
EleksZ xz, 1). 
t 
meek SZ) ( 41) += 
pixels (W), 


ticks3(W,T), 
t 


@ecksSs3(Y;T) :- 
Y >= 1, 
AY is Y-6, 
new (@TXT,text(’-’,0,AY,left)), 
send (@TXT, font, font (screen,r,12)), 
send(@pic,display,@TXT), 
Y2 is Y-T, 
EreksSy2; 1); 
t 


mreks3(_,_) :- !. 


merecalc :- 
pixels (P), 
map size(C), 
Corser, C; 
IG is P//C, 
assert (pm _ratio(G)), 
assert (ipm ratio(IG)). 


= 


Make map ;=- 
pixels (P), 
pm _ratio(G), 
new(@pic, picture (none,size(P,P))), 
send(@pic, horizontal _scrollbar,0), 
send (@pic, vertical _scrollbar,0), 
send(@pic,smart,off), 
round(G,IG), 
send(@pic,grid,size(IG,IG)), 
new _dialog(@map_dialog,none,map item), 
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new li 


del 11 


moved _ 


wt lab 


send(@map dialog, right,@pic), 

PX is 1000-P, % screen = 1150x900 pixels; dialog = 150 wide 
send(@map_ dialog, open, point (PX, 80)), 

send(@map_ dialog, label, ’MAP MAKER’), 

Stay(.,.); 

draw_border, 

ticks: 

new(@status, text block(’’,area(430, 480) 70720) Vecenter) 
send (@pic, display, @status), 

send (@pic, cursor x,cascade (@xcoord, adjustx,0)), 
send(@pic, cursor _y, cascade (@ycoord,adjusty,0)), 

send (@pic, moved, cascade (@pic,moved_line,0)), 

send(@pic, left down, cascade (@pic, clicked, 0)), 

send (@pic,middle click, cascade (@pic,del line,0)), 
interpret _messages(fail). 


ne(.)..) 2= "retractall (pormne (or % start new line 


ne (7, 2G) 

send(FIG, destroy), 

retract (pix edge (FIG,WILBL, , ,_)), 
send(WTLBL,erase). 


line(PIC,FIG) :- 

retract (pix edge (FIG,WTLBL, [X1,Y1], [X2,Y2],W)), 

send (WTLBL,erase), 

Get ( G7 nererence poine, REE), 

send(FIG, destroy), 

REF = 2,, [2)8R,YR1, 

NX1 is X1+XR, NY1l is Y1+YR, 

NX2 is X2+XR, NY2 is Y2+YR, 

new (@L, line (NX1,NY1,NX2,NY2)), 

send (@L,arrows,first), %$ option for arrowheads 
new (@FIGZ2, figure(0,0,0)), 

send(@FIG2,append,@L), 

send(@PIC, display, @FIG2), 

wt_label([NX1,NY1], [NX2,NY2],NWTLBL,W), 

asserta (pix edge (@FIG2,NWTLBL, [NX1,NY1], [NX2,NY2],W)) . 


el [X1, YI) 082) Y2 17 GW The, Wy): 
midpoint ({x1, Yi), [X25.21, [| XM7 YM 10e 
round (XM, IXM), 

round (YM, IYM), 

weights (W), 

placesibii(w, WSTR), 

new (@WTLBL, text (WSTR, IXM, IYM, center)), 
send (@WTLBL, font, font (cour,b,10)), 
send(@pic, display, @WTLBL), 

t 


Zoe 


place 1lb1l((W,W),WSTR) :- number _chars(W,STR), name(WSTR,STR), !. 
place 1lb1(W,WSTR) :- concat atom(W,:,WSTR), !. 


mena pix (POS, X,Y) :- 
pm _ratio(G), 
rouna(G, IG), 
get (POS, x,X0), get(POS,y,Y0), 
ml 25 0/6, ° Yi is Y07G, 
TOuUNnGa (cl x2), rounaty |, YZ); 
KoUGmwZ A 1G, Yors YZ2* 1G, 
t 


e1icked(PIC,@POS) :- 
(retract (point (LASTPT)) -> 
round pix(@LASTPT,X1,Y1), 
POuUndupix(@POS, K2;,Y2), 
new (@L, line (X1, Y1,X2,Y2)), 
send (@L, arrows, first), 
new (@FIG, figure(0,0,0)), %$ mouse cannot find simple line 
send(@FIG, append, @L), $ sO, must append to a figure. 
send(@PIC, display, @FIG), 
Weelapel( [xl vi, [X2,%2],WTLBL,W), 
asserta (pix edge (@FIG,WTLBL, [X1,Y1], [X2,Y2],W)), 
assert (point (POS) ) 


assert (point (POS) ) 


Senvert prE¢(Px,PY],(X,Y]) :- 
pixels(W), 
pm _ratio(G), 
XX is PX/G, 
YY is (W-PY)/G, 
mound (XX, X), 
mOuIMe (ey V,Y ) 


memvert pix( [X,Y], [PX,PY]) :- 
pixels(W), 
pm ratio(G), 
TEX as G*X, 
TPY is W-G*Y, 
rouna (TEX, EX), 
rouna(IPY, PY). 


2) 


adjustx (XITEM,X) :- %$ display transformed x in dialog box 
send(@status,string,’’), % clear status line 
Pmecatio(R) ; 
XX is X*10/R, 
£loor (XX, RX); 


send (@XITEM, selection, RX). 
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adjusty(7 LEM, we % display transformed y in dialog box 
pm_ratio(R), 
map _Size(M), 
YY is (10*M) -Y*10/R, 
EloeordyYyY, RY)’, 
send (@YITEM, selection, RY). 


mmsave (,05)) >= 

send (@status, string, ’SAVING’), 
get (@sfile, string, FILE), 
send(@sfile, advance,none), 
open(FILE,write,S), 

tell(S), 

Pix eorcoocd, 

insert border, 

told, 
send(@status, string, ’READY’). 


oe 


concat (S1,S2,S3) .:= 
name(S1,L1), 
name (S2,L2), 
append (L1,L2,L3), 
name (S3,L3). 


Pix Co%coord = 
gull 
writeln(’:- dynamic mapname/1, edge/6.’), nl, 
get (@sfile, string,MAP), 
concat (‘mapname(’,MAP,M1), 
Goncat (Mi). Mz) 
writeln(MZ), sal, 
pix _edge(F,W, [PX1,PY1], [PX2,PY2], [W1,W2]), 
CONVeEGE Pte ary i Cx ela), 
Converespes [PxX2, P1217, |Cx2, Cx2)), 


EDGE =.. [edge,CX1,CY1,CX2,CY2,W1,W2], 
portray clause (EDGE), 
Panel 


Pix Jo eeera. 


INSCrEeDOrOere 1. 
nl, writeln(’% border edges’), nl, 
b edge (X1, Y1,X2,Y2,W1,W2Z), 
portray clause (edge (Xl, Y1, XZ, Y2Z,W1,W2Z)), 
fails 
INnS€Et border. —wiml- 


draw Derdcres:. 
Db edge (Xi, Yi x2, Vc eee) 
CONVeELEt Pix Veipael, PY) ), 
COMVeEre pix ( (XZ, Volpe nape 22) 
new (@L, line (PX1,PY1,PX2,PY2)), 
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send (@pic,display,@L), 
fan. 
draw_ border. 


pmeage( 0, Oml00, 0, 1,0). 
excage (200, 0,100,100,1,0). 
meeage (100,100, 0,100,1,0). 
meeage( 0,100, 0, 0,170). 


moment ( -) 6: = 
send(@pic, postscript, picfile), 
Wniwiseverem( |prs—-Pssl pictale’)), 
unix(system(’rm picfile’)), 
unix(system(’lpq -Pssl’)), 
send(@status,string,’READY’). 


mmclear( , )} 2= 
send(@pic,clear), 
Ber rEdotad) MCageth , vane) ) 


send(@status,string,’ ’), 
send(@pic, display, @status). 


mmeodad( , ) i= 
send (@status, string,’ LOADING’), 
get (@lfile,string,FILE), 
send(@lfile, advance, none), 
eonsule (hile), 
draw edges, 
abolish (edge/6), 


send (@status, string,’READY’), 
t 


eraw cdges ;- 
edgeO (X1,Y1,X2,Y2,W1,W2), 
retractall(weights( )), 
asserta (weights([W1,W2])), 
Converempis((., vil}, (PX1,PYL)), 
COnvVemmap xX, 02 |, [PXZ,PYZ)), 
new (@L, line (PX1, PY1,PX2,PY2)), 
send(@L, arrows, first), 
new(@FIG, figure (0,0,0)), 
send(@FIG, append, @L), 
send (@pic, display, @FIG), 
wt_label((PX1,PY1], (PX2,PY2],WTLBL, ), 
assert (pix edge (@FIG, WILBL, [PX1,PY1], [PX2,PY2], [W1,W2])), 
fade: 

eeaw edges 


mmquit( ,_) :- send(@map dialog,destroy), halt. 


255 


[Aart85] 


[Aart89] 


[Adam85] 


[Akma87] 


[Alex90] 


[Barr8 1] 


[Baza77] 


[Bono84] 


[Bras88] 
[Carr90} 


[Cern85] 


[Char87] 


[Clev84] 
[Coll88} 


LIST OF REFERENCES 


Aarts, E.H.L. and van Laarhoven, PJ.M., "A New Polynomial-Time Cooling Schedule,” 
Proceedings of the International Conference on Computer-Aided Design, pp. 206-208, 
IEEE, November 1985. 


Aarts, E.H.L and Korst, J., Simulated Annealing and Boltzmann Machines, John Wiley and 
Sons, 1989. 


Adams, M., Deutsch, O., and Harrison, J., "A Hierarchical Planner for Intelligent Systems,” 
Proceedings of SPIE Applications of Artificial Intelligence II, vol. 548, pp. 207-218, 
International Society for Optical Engineering, Bellingham, WA, 9-11 April 1985. 


Akman, V., Unobstructed Shortest Paths in Polyhedral Environments, pp. 90-92, Springer- 
Verlag, 1987. 


Alexander, R.S. and Rowe, N.C., "Path Planning by Optimal-Path-Map Construction for 
Homogeneous-Cost Two-Dimensional Regions,” Proceedings of the IEEE International 
Conference on Robotics and Automation, Cincinnati, OH, May 1990. 


Barr, A. and Feigenbaum, E.A., The Handbook of Artificial Intelligence, vol. 1, Morgan- 
Kaufman, 1981. 


Bazaraa, M.S. and Jarvis, J.J., Linear Programming and Network Flows, John Wiley and 
Sons, Inc., 1977. 


Bonomi, E. and Lutton, J., “The N-City Travelling Salesman Problem: Statistical Mechanics 
and the Metropolis Algorithm,” SJAM Review, vol. 26, no. 4, pp. 551-568, Society for 
Industrial and Applied Mathematics, October 1984. 


Brassard, G. and Bratley, P., Algorithmics Theory and Practice, p. 247, Prentice Hall, 1988. 


Carriker, W.F., Khosta, P.F., and Krogh, B.H., "The Use of Simulated Annealing to Solve the 
Mobile Manipulator Path Planning Problem," Proceedings of the IEEE International 
Conference on Robotics and Automation, vol. 1, pp. 204-209, Cincinnati, OH, May 1990. 


Cerny, V., "A Thermodynamical Approach to the Traveling Salesman Problem: An Efficient 
Simulation Algorithm,” Journal of Optimization Theory and Application, vol. 45, pp. 41-45, 
1985. 


Chamiak, E. and McDermott, D., /ntroduction to Artificial Intelligence, p. 435, Addison- 
Wesley Publishing Co., 1987. 


Cleva, SJ., "High-Tech Maps,” Army, pp. 33-38, November, 1984. 


Collins, N.E., Eglese, R.W., and Golden, B.L., "Simulated Annealing - An Annotated 
Bibliography,” American Journal of Mathematical and Management Sciences, vol. 8, nos. 3 
and 4, pp. 209-307, American Sciences Press, Inc., 1988. 


256 


[Defe74] 


[Dent&4] 


[Digi88] 


[Edel89] 


[Garc89] 


[Gree84] 


[Grov86] 


[Haje85] 


[Huan&6] 


[Iyen89] 


(John89] 


[John90} 


[Keir84] 


[Keir88] 


[Kirk83] 


Defense Mapping Agency, Hunter-Lig gett Special, edition 1-DMATC 1:50000, stock no. 
V795SHUNTERLI, Topograhic Center, Washington, D.C., 1974. 


Denton, R.V. and Froeberg, P.L., "Application of Artificial Intelligence in Automated Route 
Planning,” Proceedings of SPIE Applications of Artificial Intelligence, vol. 485, pp. 126- 
132, International Society for Optical Engineering, Arlington, VA, May 1984. 


Digitizing the Future, 2d ed., DMA stock no. DDIPDIGITALPAC, Defense Mapping 
Agency, 1988. 


Edelsbrunner, H., Algorithms in Combinatorial Geometry, pp. 244-245, Springer-Verlag, 
1987. 


Garcia, I., Solving the Weighted Region Least Cost Path Problem Using Transputers, M.S. 
Thesis, Naval Postgraduate School, Monterey, CA, December 1989. 


Greene, J. and Supowitz, K., "Simulated Annealing without Rejected Moves," /nternational 
Conference on Computer Design, pp. 658-663, IEEE, October 1984. 


Grover, L.K., "A New Simulated Annealing Algorithm for Standard Cell Placement," 
Proceedings of the International Conference on Computer-Aided Design, pp. 378-380, 
IEEE, 1986. 


Hajek, B., "A Tutorial Survey of Theory and Applications of Simulated Annealing,” 
Proceedings of the 24th Conference on Design and Control, pp. 755-760, December 1985. 


Huang, M.D., Romeo, F., and Sangiovanni-Vincentelli, A., "An Efficient General Cooling 
Schedule for Simulated Annealing,” Proceedings of the International Conference on 
Computer-Aided Design, pp. 381-384, IEEE, 1986. 


Iyengar, S.S. and Kashyap, R.L., "Autonomous Intelligent Machines," Computer, vol. 22, 
no. 6, pp. 14-15, IEEE, June 1989. 


Johnson, D.S., Aragon, C.R., McGeoch, L.A., and Schevon, C., "Optimization by Simulated 
Annealing: An Experimental Evaluation; Part I, Graph Partitioning," Operations Research, 
vol. 37, no. 6, pp. 865-892, November-December 1989. 


Johnson, D.S., Aragon, C.R., McGeoch, L.A., and Schevon, C., "Optimization by Simulated 
Annealing: An Experimental Evaluation; Part II, (Graph Coloring and Number 
Partitioning),” to be published in Operations Research, 1990. 


Keirsey, D.M., Mitchell, J.S.B., Payton, D.W., and Preyes, E.P., "Multilevel Path Planning 
for Autonomous Vehicles,” Proceedings of SPIE Applications of Artificial Intelligence, vol. 
485, pp. 133-137, International Society for Optical Engineering, Arlington, VA, May 1984. 


Keirsey, D., Payton, D.W., and Rosenblatt, J., "Autonomous Navigation in Cross-Country 
Terrain,” Proceedings of DARPA Image Understanding Workshop, pp. 411-416, Defense 
Advanced Research Projects Agency, 1988. 


Kirkpatrick, S., Gelatt, C.D., and Vecchi, M.P., "Optimization by Simulated Annealing,” 
Science, vol. 220, no. 4598, pp. 671-680, 13 May 1983. 


pny | 


(Lewi88] 


[Lin65] 


(Lind87] 


[Lund&6] 


[Metr53] 


[Mitc&4 ] 


{ Mitc87] 


[Mitc90] 


[Naha85] 


{Naha&6] 


[Otte89] 


[Papa82} 


([Papa85] 


[Pear84] 


[Prep87] 


Lewis, D.H., Optimal Three-Dimensional Path Planning Using Visibility Constraints, M.S. 
Thesis, Naval Postgraduate School, Monterey, CA, May 1988. 


Lin, S., "Computer Solutions of the Traveling Salesman Problem,” Bell System Technical 
Journal, vol. 44, no. 10, pp. 2245-2269, Bell Laboratories, December 1965. 


Lindsay, C., “Automatic Planning of Safe and Efficient Robot Paths using Octree 
Representation of Configuration Space," paper presented at the IEEE International 
Conference on Robotics and Automation, Raleigh, NC, 2 April 1987. 


Lundy, M. and Mees, A., "Convergence of an Annealing Algorithm,” Mathematical 
Programming, vol. 34, pp. 111-124, North-Holland, 1986. 


Metropolis, N., Rosenbluth, A.W., Rosenbluth, M.N., Teller, A.H., and Teller, E., "Equation 
of State Calculations by Fast Computing Machines,” Journal of Chemical Physics, vol. 21, 
no. 6, pp. 1087-1092, June 1953. 


Mitchell, J.S.B. and Keirsey, D.M., "Planning Strategic Paths Through Variable Terrain 
Data," Proceedings of SPIE Applications of Artificial Intelligence, vol. 485, pp. 172-179, 
International Society for Optical Engineering, Arlington, VA, May 1984. 


Mitchell, J.S.B., "Shortest Paths Among Obstacles, Zero-Cost Regions, and Roads," 
Technical Report No. 764, School of Operations Research and Industrial Engineering, 
Cornell University, December 1987. 


Mitchell, J.S.B. and Papadimitriou, C.H., "The Weighted Region Problem: Finding Shortest 
Paths Through a Weighted Planar Subdivision," Technical Report No. 885, School of 
Operations Research and Industrial Engineering, Comell University, January 1990, to 
appear in Journal of the ACM. 


Nahar, S., Sahni, S., and Shragowitz, E., "Experiments with Simulated Annealing,” 
Proceedings of the 22rd Design Automation Conference, pp. 748-752, IEEE, 1985. 


Nahar, S., Sahni, S., and Shragowitz, E., "Simulated Annealing and Combinatorial 
Optimization,” Proceedings of the ACM/IEEE 23rd Design Automation Conference, pp. 
293-299, June 1986. 


Otten, R.HJ.M. and van Ginneken, L.P.P.P, The Annealing Algorithm, Kluwer Academic 
Publishers, 1989. 


Papadimitriou, C.H. and Steiglitz, K., Combinatorial Optimization: Algorithms and 
Complexity, Prentice-Hall, Englewood Cliffs, NJ, 1982. 


Papadimitriou, C.H., "An Algorithm for Shortest-Path Motion in Three Dimensions," 
Information Processing Letters, vol. 20, p. 259-263, North-Holland, 15 June 1985. 


Pearl, J., Heuristics: Intelligent Search Strategies for Computer Problem Solving, Addison- 
Wesley Publishing Co., Reading, MA, 1984. 


Preparata, FP. and Shamos, M.I., Computational Geometry: An Introduction, Springer- 
Verlag, 1988. 


258 


[Pres88] 


[Quin90] 


[Rich87] 


[Rome84a] 


[Rome84b] 


[Ross89] 


[Rowe88] 
[Rowe89] 


[Rowe90a] 


[Rowe90b] 


[Rowe90c] 


[Rowe90d] 


[Rowe90e] 


[Sech86] 


Press, W.H., Flannery, B.P., Teukolsky, S.A., and Wetterling, W.T., Numerical Recipes in C, 
Press Syndicate of the University of Cambridge, 1988. 


Quintus Prolog Reference Manual, Release 2.5, Quintus Computer Systems, Inc., Mountain 
View, CA, January 1990. 


Richbourg, R.F., Solving a Class of Spatial Reasoning Problems: Minimal Cost Planning in 
the Cartesion Plane, Ph.D. Dissertation, Naval Postgraduate School, Monterey, CA, June 
1987. 


Romeo, F. and Sangiovanni-Vincentelli, A., "Probabilistic Hill-Climbing Algorithms: 
Properties and Applications," ERL College of Engineering, University of California, 
Memorandum No. UCB/ERL M84/34, 13 March 1984. 


Romeo, F., Sangiovanni-Vincentelli, A., and Sechen, C., "Research on Simulated Annealing 
at Berkeley," Proceedings of the International Conference on Computer Design, pp. 652- 
657, IEEE, October 1984. 


Ross, R.S., Optimal Grid-Free Path Planning Across Arbitrarily-Contoured Terrain With 
Anisotropic Friction and Gravity Effects, Ph.D. Dissertation, Naval Postgraduate School, 
Monterey, CA, June 1989. 


Rowe, N.C., Artificial Intelligence Through Prolog, p. 321, Prentice-Hall, Inc., 1988. 


Rowe, N.C. and Lewis, D.H., "Vehicle Path-Planning Using Optics Analogs for Optimizing 
Visibility and Energy Cost," NASA Jet Propulsion Laboratory Publication 89-7, vol. 1V, pp. 
217-226, NASA Conference on Space Telerobotics, Pasadena CA, January 1989. 


Rowe, N.C., "Roads, Rivers, and Obstacles: Optimal Two-Dimensional Route Planning 
Around Linear Features for a Mobile Agent," Jnternational Journal of Robotics Research, 
vol. 9, no. 6, December 1990. 


Rowe, N.C. and Richbourg, R.F., "An Efficient Snell’s-Law Method for Optimal-Path 
Planning Across Multiple Two-Dimensional Irregular Homogeneous-Cost Regions," 
International Journal of Robotics Research, 6 December 1990. 


Rowe, N.C. and Ross, R.S., "Optimal Grid-Free Path Planning Across Arbitrarily-Contoured 
Terrain with Anisotropic Friction and Gravity Effects," JEEE Transactions on Robotics and 
Automation, vol. 6, no. 5, pp. 540-553, October 1990. 


Rowe, N.C., "Plan Fields and Real-World Uncertainty," AAA/ Workshop on Planning in 
Uncertain, Unpredictable, or Changing Environments, Stanford, CA, March 1990. 


Rowe, N.C., "Construction of Optimal-Path Maps for High-Level Path Planning across 
Weighted Regions,” Computer Science Dept., Naval Postgraduate School, in preparation, 
December 1990. 


Sechen, C. and Sangiovanni-Vincentelli, A., "TimberWolf 3.2: A New Standard Cell 
Placement and Global Routing Package," Proceedings of the 23rd Design Automation 
Conference, pp. 432-439, ACM/IEEE, June 1986. 


259 


[Smit88] 


[Tove88] 


[ VanL87} 


[Vecc83] 


(Whit84] 


[Wilb89] 


[Wren90] 


[Yen71] 


Smith, T.R., Peng, G., and Gahinet, P., "A Family of Local, Asynchronous, Iterative, and 
Paralle] Procedures for Solving the Weighted Region Least Cost Path Problem,” University 
of California at Santa Barbara, 20 April 1988. 


Tovey, C.A., "Simulated Simulated Annealing," American Journal of Mathematical and 
Management Sciences, vol. 8, nos. 3 and 4, pp. 389-407, American Sciences Press, Inc., 
1988. 


Van Laarhoven, PJ.M and Aarts, E.H.L, Simulated Annealing: Theory and Applications, D. 
Reidel Publishing Co., 1987. 


Vecchi, M.P. and Kirkpatrick, S., "Global Wiring by Simulated Annealing," /EEE 
Transactions on Computer-Aided Design, vol. CAD-2, no. 4, pp. 215-222, October 1983. 


White, S., “Concepts of Scale in Simulated Annealing," Proceedings of the International 
Conference on Computer Design, pp. 646-651, IEEE, November 1984. 


Wilber, R., "Expert Systems Aid On-Board Mission Management," Defense Computing, vol. 
2, no. 1, pp. 27-30, Cardiff Publishing Co., January/February 1989. 


Wrenn, L.R. IH, Three-Dimensional Route-Planning for a Cruise Missile for Minimal 
Detection by Observers, Technical Report NPS52-90-028, Department of Computer 
Science, Naval Postgraduate School, Monterey, CA, May 1990. 


Yen, J.Y., "Finding the K Shortest Loopless Paths in a Network", Management Science, vol. 
17, pp. 712-716, 1971. 


260 


INITIAL DISTRIBUTION LIST 


Defense Technical Information Center 
Cameron Station 
Alexandria, VA 22304-6145 


Library, Code 52 
Naval Postgraduate School 
Monterey, CA 93943-5002 


Man-Tak Shing, Code CS/Sh 
Department of Computer Science 
Naval Postgraduate School 
Monterey, CA 93943 


Neil C. Rowe, Code CS/Rp 
Department of Computer Science 
Naval Postgraduate School 
Monterey, CA 93943 


Vincent Lum, Code CS/Lm 
Department of Computer Science 
Naval Postgraduate School 
Monterey, CA 93943 


Walter M. Woods, Code OR/Wo 
Department of Operations Research 
Naval Postgraduate School 
Monterey, CA 93943 


Clyde Scandrett, Code MA/Sc 
Department of Mathematics 
Naval Postgraduate School 
Monterey, CA 93943 


Robert E. McGhee, Code CS/Mz 
Department of Computer Science 
Naval Postgraduate School 
Monterey, CA 93943 


MAJ(P) Mark R. Kindl 
3560 Eagle Landing Drive 
Lithonia, GA 30058 


261 











i 


| Thesis 

| K42455 Kindl 

Pcl A stochastic approach 
to path planning in the 


Weighted-Region Problem. 


i 


Thesis 
K42455 Kindl 
‘ape A stochastic approach 


to path planning in the 
Weighted-Region Problem. 




































































































































































































































ind 
ei Sebel age ais 
‘Eo piy 
] i , r 
| HH ‘ y F ' a i tg 
att 1 ; se : : . 
(ck Ab fe 38 ; 4 } ee ks) ie ; . 
“+ Py Gg A p F ' 
me ne? : yeaa . 2 ; f ; ' 
arate ak 4 tH rad a . 
ph ate a ¥ SUEY, \ eee -f .* 
a aa renee a 
Ri ar Liha s tae = 
z at i 
“i ' 
i 
1h i ; 
GRE Sears | 
Bact eat Hy 4 . si", 6 . 
eke feats ' 
Nix Kbit as so. Y J ' 
ans & eit , 
‘ ey) i ce O84) rt 
‘ ena nian Phe 14) BW : 
ap Ne Atws cee iptey foe et Ae 4 
rag ye ry ie bed fe}5 Bi. ; 
y aye <i) rat Be ' 4 
Fak! ; 
i At] hep 
‘ ‘ ' ° 
‘ 
‘ae 4 
' 
Ps ' 
' 
' 
; ' 
«) A 
hen, *, al ar: “e 
bes sehb ® i! At} x F 4 : 
ruth ea ai Fe eh 
rf ud Hesi5-8 he ¥ < 
(te aye BS C) 7 7 
Ae Renee eG gs er 4 » f 
yy ee Por tr aa’ tag at ® 7" 4 a thst i 4 4 
>) . d On 44 ARUP Cy af el , hsb tae’ rr a§ cael tl ' 
betes RIS Pee Mee tA Att rai Mesure Cake Re Be ee vet” oe 
cAreR pas ih, Dyn He wes ipl aie £31 ps eee: Sra Le TE. .: PAS es ee agree ey : 
‘ '. z z ‘ Oe oy a fia . * t_be a a! i « I ‘ t 
ee Sebed ae Pua eens Ps , i fat a t Ao 7,64 tp aed me ‘2 ae me ar a’ as qote Sf a! ease ‘ eY Ae He : x > TORO ’ 
e Aree te : hee 0 “a a a®v.d. Ee f get etal ot at shot i, wT % ‘on | Sines t, ' sa 
a 4 i . 4 4 e 4 * ‘ ‘ s Find H 
fee et i ‘ a’, tes rr ; t' Le “t a. ‘ Citet e ght at ot € are ’ oe 4 | Pi 
- ‘ He 
aren ey? . le TF ' a ’ a ae" Be ‘ ' vr + nbs t ' ' 
gulse 4 ake, 6 4 6 a ow ts it - 1% ,¢ t F ca * “ 
rey » rf 24Fets ‘eres £ : Hs Riis, RIN ee 1 ‘ ae 5 : oe : . 
ae 0%.9% i i RrTEat SS TO CF at : vs : 1 1 oi 2 é a’, i vic nea 
ase, We oe r . ~ (abe g ‘ he 1 - Fe 
iM ‘ »" Rs =o! vier oNsyts 2 i i= " ' ' + 4 
4 . mt coat ; 
, N Fe frig Fee ae § a ea ? ‘ ’ aie 
aK es ong ote ee a Po “ig ‘ Pare - ' | ? ; 
ta " Piss om? 05,5 3 = . : won H 4 : ’ ’ 
; Z ert ° ee :, Gee iit ‘4 bit ys ee . : qe it ; Che ; Lames Pa é ¢ ' 
ti % 
vats 1g! Nee “ 3 + 3: ‘ey ake pap z : : ae : 
Mes apy +s “ Reis ra” Ore : if preety >/ ry YS <9 30h , yh a : sae ee re £ 
33 << mae A th Rate eee 2h a apart os i> ef? ii wa,” ot ave aee sis * ft 1 4h t ‘4 vite aes poe 
ae ai i) ae i ‘ Pere: me "ate Te 4" 8 : ea Peet es. 
he sy é nil ; : "* ala te, A Sages Po ao diy) as? i yu ‘ “al (Abd Ge — nie =) 
2 RSUS Fi es ‘es Ah zit Beka ay yh j te role hy i: ; es - Td A ott wh ae We AST heh " ce P «| I he Byte} ’ eek . Tas Se ms wt A 8 
ee Sh Me : } . opt N ty eae ih, cout ity re hy deat arts Pa es rtd @ ed > ua B° ae { Sa es Be » * “OH ty) ue 3 
4: be. be ay 4 aes Y es vehi ' > , tees omy ass ‘? ha hed at et btsst r . <i ea ¢%, , ry af ss teh fe ri e 
wed. wt ve P5733 Ne Wk aos $44 os) dey ; i 1fw'y}S : rn ie it! Se eee EM sat tae Pree’: 3 9) aie ee ote “ae: oe 3 : ties U ’ 
Na i e. ifKe * sebek He ite 2 ATM av ‘ r ; ¢ 3 +s alive he Fae bie aby aly gs a ‘ te , whe ris “vie Loader 8 : ther ue ¢ then 
wie iy e: , A] Sach, Av; a a" ‘ 4 Set] sph: % & S38 i es. 4 maa gts! + oe ’ cps gtate ch oe t 7 e 
mie : Naihee sth aye 4 ee 3 ~ i } 5 Pting al. ' rae “telat re re nepekiar sharct rs : teste F } re ae : 
Aad 5 Ya ee are Bi 5, Oy ; Hy Poe, 36a Nd = jee ¢ te oh de oawey es 15) oar ‘a s 8 a fs Rin ' 
e b 1! 1 i : é "9 * ” é 3 a a L. te 
> : ary = gb eon Se bi TBS 4) " ie esthie,> ame <a ae $ ates ; ' 
4 , i ey Av er; son wtyhat vey i ' ® 
4 aie a . iain » Ane v: o* a 8 2 a a Si 2 ‘ 
; at I ar . PLY 7 » eS &e! Aste , new an phx eta ne 7 } * 
j gies a é ‘ ' “ sf A : ' = ~ 
¢ <5 [ | Lihat A pes ‘ Z ' 1 L 
mad 2 « ant ou) ae £8 » he a al > Saar € " ' 4 
ae 5 Me « hate ea pets ate Hise ; o H By ' A x ; 5 oe ‘ - . if ' 
oh ag ae io ae ; s eg ibe itd fan (oh 4 Ser” yy . * tt Pe " i * . 
ri aa a ‘ ous 
Rew DS Cie ae rn ee EES ceed. Pals td Hohe niere wey | At ayy ete hr 
ese oh Nt Siebent at vies RG coat ho oF | a e yt Me) a hae bee ! ‘ 
1 i Aee,9 AMS 2M ony os ola eet gt Ye es Ae a oy? 5 a +4 & 4 : 5 t, ar 4 . : 
ea HE “ 5 qatar: ates gt art} a? 67s) ay “ eopicke €« } BE ag ese ‘ 
oh aay 34. x Rye % SAA i idak Moy, 4 4; sy ri 1 oa . at sh na a ¢ : ots in ; - : 
— 0 f Hu ‘‘s 2 y ® x 
i Ak Athnte west (te (aes ihe i 5 ett? eae | - ’ B50 tot hy c Nouee a fa At : oa ; : : 
ah ava 2} ty : 4 ; hehe J at etjee ; ae hy? ate? Ags ies Le ¢ art eee cig OM 5 2. Pars H ' 
_ 5 rT © ess r «tae * Ss nat ¢ 4 
has boda f : a it % B} ; aS Stet It ; . 4 e 2 ’ frate FCELY SRP UF g isn. | aR, oa ’ ; 
ey pa feds ais a a aap eoicity wee Fa {ee ua tees Bae fey : 
y aes Hie we : ; amy" i ike 4 Re mie es pi! 344 ah 4 ‘e a3 sell ene =n I 40.8 ere . ave a . ts - ee 
¥ d c % th a> tay = a f , oA ‘ bal . , ' Pi 
oa i a oe yt: tt ‘ ‘ * . es 
to ; x % Wave * XS ; . me . 
$ ; : i ry gus @ A ' Par 
ar by a 3 y. vis hen ett Vat! Oo Tiara ’ ‘ ' 
ie > % s 
/ Ty. > wtih a 7 : : 
z i , 1A fi %e,° ty » ‘ 
R ft Me i 5hd 1 
ey rd 7 ~§ We 
aR ) bey on 
} fos tee + 8\e 
aces Fi ‘ ‘ 
ve 
Pata are 
fie uh, , 
Tite b ' 
a Fase Tae oy Pa: , 
; see nak x ¢ ‘sl PM a : ve 
m vay) yh Regu. * 
ME x) Neb Wy 8 Goctey ti, eis Te 
‘ : ie en Qys ' ‘ : 
¥ 4 Lue q,8) 
€ ef wo“ ) fag” 
a** =he _ 
; t ae #44 Asie! : 
ae i ae 4 a 
4) 
: a ‘ uj are “3 Lr ‘ Ae bs, ec i JO *. 
} ‘ rt wb eggst he aw ile Yel ighgs 
: af L f . r 'e & ee! oo oh A ¢ xi al L = 
arr ie “ta ET ae ay Avnet eaten al Ae eee gsity guise: tana teh ¢ r ' ‘ 
ius Ra bas byt 4 Dads 1? ag diek a} a ard 4 A. aan ia a 
 &. fh 14 4 é a * 
FN , i eae gate Mt aint te? Vid aia: eo Verify any E sR Shed ; : 
Yes fd be aaa re : ely ct * 9, yer » fale oie Ne b) wh. wh ‘6 a] Ps, f : 
ae aie ‘ Pathe \ ops sat, tt guise tad tt? a He teat wn puree ee! ; ‘. 
4 se Oey nh SAR F iar Sey Lite it ety ra Pa) had ay miss Mie era fe 8 Ate Ha ‘ 5 Fabel, Sind ‘ { . 
0 J . ‘ AP, : (wae . , ! ‘ . Fae es | ' 
SES cue miciataae a eae Rea eRe bain esa es cae wel nels B ccipt hit tet - : 
. Ys aa n r be . 17y 4 cue. 2 “E e . # ‘| , 8 eats ees: ee « ‘ “sy 5 
{i bets rey ye enge% ys put ee aut ~ i a 4 a4 : a8 Pi fot. 33, , te 7 
a. 4 ie ae Sa meek, iy; He 434), bibs ate ite i) 4 * nah ill SSNs BREE cite yu tie Coss anata ; 
*% “ye sete, oN {ore + & ive re bk ® A ‘% a, } A on pieae ‘ ry seta " etgton = ta a! 
Fa ran Kees hs nb be, ba! aie Stem, i po 0 0 i ee ' e*) aa ahee ¢ 
Moin: {ital ou 74 a eS f ¢ tate ack ay a! “Hh et Us - t,'8 ore e! rhe ; 
sypberiteens SRI Pa 4 7atit ised 9 5 a 1! 3 3 wees sacl ’ " otek Ne Me ; nae 7 Mle re 4 oy “i * i ( « : i 
w? 158 k oe a : ° -ia ft : > my Cet y ot wtet Li a aia one H ' 
ai Ws aiKy ‘ ve Sa eR mo v3 a ih! Pt) 1 qe q aie Hae sts ‘yin: = ss, Perth rag ptees oe ser yeh is Rae het * 
Me Ay 220% w ha ‘ af. ~ * & jf - A ot =H beg hes . ¢ PLC ° 
Mt ral eae ee YY: ip: RS Oe AF 5 : “sraapien! | ae ry 28 on igi » Mae ars bie Boe o@ ght’ * bv H ie es el ri 
bias vf 1 EATS 2 be 34 Pah é Hey. . 49 f : et oe 1c it’ RS feate0e ed ete 
aa ey a ae RG Oe > 3: oe y +” J es OL ogi aeg ital H ARH: vif 4p ‘e? 1.9 : é a ae rt c eee - oss os! no OP . oF us 
Roar es * : pis sy + af he é # 9% “, 0 us oe of Uh Ss Tele t ee , 
1 ECR Ty mt se { ap if) ON ay "ashes hea iM) set! Lah $F % { Pooe tt Ae H fy a t aS A a . s hs 
% pers Ls * a ee? Ue | oy FI e)° ; > 
¥ +s Bs ( si T ag ay { eat} a, ay ‘ apart ‘ Vise “ be a, ‘ : 
ay oe Pt! < ; ‘ ab.4 8 P| 3 Lr etd . ' ! ' 
re 8 ne &: init 7 as Py 98 '¢ ¥, of aan ary ’ ? wee ; pean. é ‘ 
¥, } We vy Ye He " +m gt, 4% casgae I. 
aR Ry ae : Sie re i ce tee | ee atte The ee es, ., 12,8! ¥ ; Can ut ann ES ‘ 
3¢ a ry Ay oe? a aed if. fry a + he hs ' . . * Oy 
ne ) tak 4 ‘i + sh ths art i 24. t3* “7 con a7 t i : . 4 i a : ‘ i He 
eS Ale si tke ta 9 iL % oe ve ern Ale 20) 4) P ary bee 5 ale P th pu i . . 
te & Ne Y, . * ¢ mia it a 1? ay ’ Me : ‘ aku .? ‘3 ' 
ab: ay # ° Y sit Ars Nest at Rive \ “ti; 1 “y Se a] Sa "ay ee ih ey RUG ; be 7] aa | | ees Re A ‘ ;; eicikane . re ' : 
, 7 7 5 Hts: aaah 2 © {AE AY vf oan Aad Lp in wg wt a. 1 errs ee i f a} ° 
A uw! . Mec ree 1 Mae dene t ‘ D an cate at ‘ ' ot i wot ob? ‘ ¢ Aan : 4 ‘ 
‘ ? a » &) HR; eee Pus 5 st Singi, %s | tee « i bs ¢' ‘ L? bd Ut j 
: Ls salpse Ne fs 5 «th boss wer bs Oy i #4: Ue © ely‘ ‘ , wee nis wy? ke pF 40 i) Pin ' : 
‘ ’ y Hs a ett ay aoRe 43 ery Parte § Poy 4 aC ai “gf if ars ph ‘ rig NW ye : a ery . 
ul eresatareaere ¥ ns » > . Pe ae. p a) Oye EE Ge 4° at, r ” a reste ' re SC , nite 4! wh P te F ' ; 
: eh 70 ithe ivdres 7 iy: ¥ ' Sa.F § "4 che besey sae AAS i Lae ey rye a fees 7 \ | ‘ awe] Sore tay 
O 4 foes . A 5 Pf at : é . 
atts a $44 oe TRY e ir, ah te an ce } y " 7 ? bp» 3 Pu A a ‘ 7 ott he - af’ ay MU .Y te, Hi _ ¢ ny 5 ‘ 
ide. wi Senate yee 7 i 1 ' % eet ; a’ % 3 , Ae ‘vo: ots eh Poor ue or ‘ 5 ae Ret F #, 2 ; : ’ : 
3 " Y } <9 " ' ate * ri 4 ate ® ' ' 
at eT oe ak foe Nites Siar, te ie be ch we” le wa dt S Bete tae eS a r- 
ae “ay . fis ¢ yey wise yelh, ry 7: Wh Abe date ah ° 7 ¥ pean Pe .“! tari ry, ask il 50s Bites . & : ’ 
meen ty Tee i enkan ae S? 3m a > rea hl re $4 eee , apa A a Ae : ; ‘ J ’ 
: Ap fie nie © > ie pee J ; J , 3 Fi 5t Wa i iw ‘ U ae 4 «vy i yee gy HO if i! “ e* 
&, ’ my OP a 3 ct A . i 
7 aka A F “ta ait am 7a case 2 Te i 4 ed feat 1, 48 st ‘a ads te . 
‘ ¢ ; 4 he cg mT ‘. ae oe wl LPS) Ay Ys ty . 77 ' i. a. 1 A ted 
v rs “4 , ‘ aa ; a * 1 s bets a® ’ - : to ' 
. _ 7 = “ 7) , agi P eee : : ' ] R 
; j foe oe a. ai,% thy) “/ ; - te he’! ae 9 x ae oa hi hee 
‘ i. ne oye * Ch ae » CBA K 3, %, 4 ae x } . j e 4 A ‘ ‘ * 
? : A Ae ¥ eet be) "98 are ; on a cnet & ely i Pom ee f.. id 4 wn ed i, ‘ . vet ir, ' 
J : 4s . “. ‘ § s Base’) ° 
. 4 , FC ip ; ay - be " L % Us ‘ M ‘ ae , ie ? a phn 4! 
pee he eet th ae a fete. an Le . 4 . eb 2 Ses ; 
Ah iby! . + (ey + 9 veh a ae ! Ye any . x > ‘ 
, ; . POH ea ¢ “eee Pe 7 iG ae ; ri - 
+b Mee ; f fis Som 8 Ace MTP) = <! : i : Ee ‘ 
Sy Cin? “ae : - wis) hus vite a! the 
: A . 
pace . on eae 
O74 45) ae Mh at ' 2 he +o os 
hd Le rate hee Res ey 
vik Ak ree aye a8 t 
n.d 3 : Pa 
Dt, rt | 47s; 16 / é ' s 
p>. PY * Abs - , a ior ' 
be ated tn ba eutng A ‘ : ' 
Ly, pose oi of 33 ar ; : 
Fy a re * te ee ' ’ 
* ce As x ¢ ae ; 
Ls 
TRY a erarge ne ‘ ; 
oe Pe Oe 
5 i a 5 i wi . a 7 ' ' 
wap, bh ces, v ony Hire ts i : 4 
r Le ae ed rie ety y , ' 
‘ a 1 ahs ' a fh : i ;. 
olf ta ’ . 
x F I = ' 
a 
2 P 
“i ; : . 
asd ; , 
' a 
Sak ' 
i 
e ‘ 
é ’ ' 
P . 


fe, ¢ 
hr 
ere 
eed oe Bd es 
Spas a a “e a re eegentae 

i ¥ ee fe wy: : ta / KY 

Temi bie aang or eB stato: hen ae 

‘om 5 ded 2 k 

et JLT. rhe 
‘ a sat 4 ; ff i] oe Hal j y ¥ 
, na . ssf ; i 


2 eee 4 
oe teen ene Ee 
peta ae Pasi ets & aetetsteare: 
> Se Lae We: pa: eS one BE iw ® ~ 
Sho: on Wee Syd ays 4 
Fe i phe Es ‘ He : 
, : Ny 4 of sigh tire ig , | 
dy » tg : é A 4 ba*e's Bie vii 
a Rite yrs ree. 3 


re 37 
; a eo 
* rf fs Ait .d 
a 
# a 5 AN 
na rs f 4 ' 6 ~ . y 
es 


